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Abstract 

A  three-finger  precision  grasp  is  used  to  rotate  a  cylindrical  object  about  a  threaded 
post.  Three  fingered  grasps  are  unique  in  that  the  homogeneous  solution  for  the  contact 
forces  produces  a  grasp  force  focus.  Mapping  of  focus  points  which  meet  grasp  stability 
and  joint  torque  criteria  results  in  a  usable  focus  region.  The  effects  of  applied  torque, 
contact  location,  and  object  position  and  rotation  on  usable  regions  are  presented.  Stability 
behavior  about  the  region  is  also  examined.  Results  are  used  to  demonstrate  a  technique 
for  robust  grasp  design. 


Robust  Grasp  Design  Using  Grasp  Force  Focus  Positioning 

/.  Introduction 

1.1  Motivation 

^  The  versatility  of  robotic  hands  permit  fine  motion  manipulation  on  a  wide  variety 
of  objects.  This  distinct  advantage  of  manipulating  an  assortment  of  objects  eliminates  the 
need  for  multiple  custom  end  effectors.  Todays’  economy  demands  that  new  technology 
advancements  lead  to  operational  systems  which  are  efficient,  robust,  and  low  cost. 

Perhaps  the  most  cicrirable  characteristic  for  current  technology  is  the  ability  to  perform  a 
wide  variety  of  tasks  with  a  single  system  configuration.  Robotic  systems  configured  with 
articulated  hands  have  the  potential  to  satisfy  each  of  these  attributes  and  more. 

With  the  advent  of  articulated  hands,  such  as  the  JPL/Stanford  hand  and  the 
Utah/MIT  Dexterous  Manipulator,  much  attention  has  been  focused  on  addressing  the 
problems  related  to  the  grasping  and  the  manipulation  of  objects.  Programming  or 
"teaching"  a  robotic  hand  to  perform  even  the  simplest  of  tasks  is  a  challenge  and  requires 
that  each  complex  problem  be  broken  down  into  solvable  portions.  A  basic  requirement 
for  performing  many  tasks  is  knowing  hew  to  correctly  grasp  an  object  so  that  it  can  be 
manipulated  in  a  safe  and  efficient  manner. 

A  type  of  grasp  used  to  rotate  a  cylindrical  object  aboi".  a  threaded  post  is  called  a 
three-finger  precision  or  "tripod"  grip  |l:pl534).  This  type  of  grasp  configuration  uses 
the  tips  of  the  thumb,  index,  and  middle  fingers  to  hold  the  object  for  fine  manipulation 
tasks.  After  establishing  a  secure  grasp,  the  coordinated  joint-action  of  each  finger  imparts 
the  rotational  motion  of  the  object  about  the  post. 
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Typically  the  task  described  above  also  requires  the  hand  to  apply  torque  to  the 
object  to  overcome  external  forces  acting  on  it  such  as  friction  Developing  an  analytical 
technique  to  successfully  perform  this  or  similar  tasks  with  a  robotic  manipulator  is 
complex.  The  solution  to  this  problem  requires  the  determination  of  the  correct 
combination  of  kinematic  parameters  and  contact  forces  to  accomplish  the  task. 

One  basic  requirement  is  that  the  robotic  hand  must  securely  grasp  the  object. 

This  implies  that  there  is  no  loss  of  contact  or  contact  slip.  In  addition,  the  grasp 
employed  must  be  within  the  capabilities  of  the  hand;  that  is,  the  resulting  contact  forces 
must  not  exceed  the  joint  torque  limits  for  each  of  the  fingers.  Ultimately,  a  single  grasp 
configuration  must  be  determined  "•  complete  the  task  successfully .  A  single  grasp 
solution  is  desirable  since  it  avoids  the  implementation  complexities  of  regrasping  or 
adjusting  contact  forces. 

Specifying  a  three-finger  precision  grasp  presents  a  multitude  of  ways  in  which  the 
object  can  be  positioned  and  oriented  with  respect  to  the  hand.  For  example,  the  object 
-an  be  held  in  close  or  extended  away  from  the  hand,  or  it  can  be  biased  to  one  side  or  the 
other.  Simply  stated,  there  are  various  ways  to  hold  or  "grip"  an  object  for  manipulation 
tasks.  The  fundamental  problem  in  choosing  a  single  grasp  solution  is  determining  which 
grip  provides  the  best  solution. 

How  to  grasp  the  object  relative  to  the  hand  requires  an  in-depth  understanding  of 
how  the  position  and  orientation  of  the  object  effects  the  hands  ability  to  maintain  a  secure 
grasp.  The  resulting  spacial  relationships  are  important  since  the  joint  torquing  capability 
of  each  finger  is  limited.  If  the  external  forces  acting  on  the  object  are  significant  in 
magnitude,  then  one  must  also  determine  the  best  way  to  hold  the  object  so  that  the  hand 
can  oppose  these  forces.  This  overall  planning  process  is  referred  to  as  grasp  planning 
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Real-time  implementation  problems  also  become  evident  during  the  planning  phase 
due  to  differences  between  the  system  model  and  the  actual  robot  hand.  Errors  due  to 
sensor  limitations,  modelling  assumptions,  control  schemes,  and  external  disturbances  can 
have  a  significant  effect  on  the  successful  completion  of  the  task.  If  the  expected  error  can 
be  specified,  then  it  too  can  be  incorporated  into  the  grasp  planing  solution.  Doing  so 
results  in  a  grasp  which  is  infierently  conservative  or  robust,  and  represents  a  planned 
approach  for  using  the  grasp  to  absorb  errors. 

This  thesis  focuses  on  the  fundamental  problem  of  grasp  planning  using  m.ulti- 
fingered  robotic  hands.  A  three-finger  precision  grasp  mode!  is  used  to  simulate  the  task 
of  rotating  a  cylinder  about  a  threaded  post  while  opposing  an  external  moment. 

The  problem  of  grasp  planning  was  chosen  because  the  result  will  contribute  to  the 
solution  of  a  larger  scale  task  currently  being  studied  at  AFIT;  a  task  which  demonstrates 
intelligent  part  mating  skills.  The  specific  task  involves  the  use  of  a  multi-fingered  robotic 
hand  to  affix  an  oil  filter  to  a  threaded  post.  This  study  focuses  on  o  aining  a  grasp 
planning  solution  to  the  combined  problem  of  rotating  tiie  filter  about  the  threaded  post 
while  applying  continuous  torque. 

1.2  Objective 

Using  a  three-finger  precision  grasp,  the  contact  points  on  an  object  determine  a 
plane.  This  type  of  three-point  contact  layout  presents  a  special  geometrical  property  for 
analytical  use.  If  a  line  is  extended  in  both  directions  along  the  internal  force  vector  at 
each  contact  point,  the  three  lines  will  meet  at  a  unique  point.  This  point  is  termed  the 
grasp  force  focus  12;31. 
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This  study  examines  the  combined  effects  of  three  facets  of  grasp  planning:  1) 
contact  stability,  2)  joint  torque  limitations,  and  3)  grasp  robustness.  Contact  stability  is 
defined  as  the  ability  of  the  end-effectors  to  maintain  contact  with  an  object  without 
slipping  (4:pl91].  Grasp  robustness,  as  defined  here,  is  the  ability  of  the  initial  grasp 
configuration  to  maintain  stability  in  the  presence  of  errors.  That  is,  the  design  of  the 
grasp  configuration  (object  position,  orientation,  and  contact  locations)  is  such  that  the 
sensitivity  to  external  disturbances  is  minimized.  This  results  in  a  conservatively  designed 
grasp  ^or  the  specific  task  application;  thus,  the  grasping  and  manipulating  ability  of  the 
grasp  is  sub-optimized  to  achieve  a  specified  level  of  robustness. 

The  study  objective  is  to  develop  a  grasp  planning  procedure  for  grasping  and 
manipulating  a  cylinder  using  a  three-finger  precision  grasp  The  manipulation  task 
simulates  rotating  _  ylinder  about  a  threaded  post  while  opposing  an  external  moment. 
Using  the  procedure,  the  user  can  determine  a  single  grip  which  guarantees  grasp  stability, 
robustness,  and  high  torquing  capability  for  performing  the  manipulation  task.  A 
generalized  model  of  an  existing  robotic  hand,  including  joint  torque  limitations,  will  form 
the  basis  of  the  analysis.  To  achieve  this  objective,  the  analysis  utilizes  the  method  of 
grasp  force  focus  positioning. 

1.3  Background 

In  a  recent  publication  15)  it  is  stated  that  "The  majority  of  the  literature  to  date  on 
multi-fingered  hands  examines  kinematic  design,  generation  of  stable  grasp  configurations, 
and  the  use  of  task  requirement  as  a  criterion  for  choosing  grasps  (61,  17);  (8);  |9);  (10); 
(11)''.  These  studies  demonstrated  various  techniques  to  analyze  the  complexities  of  multi¬ 
fingered  hands  using  simplified  planner  models.  In  addition,  several  concentrated  efforts 
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have  also  developed  control  algorithms  to  address  the  difficult  subject  of  rolling  and  sliding 
contacts  [2];  [12];  [13];  [14];  [15].  The  combined  results  represent  significant  progress 
towards  proper  grasp  planning. 

Three  recent  works  have  developed  techniques  for  grasp  planning  which 
incorporate  grasp  force  focus  positioning.  Unlike  other  methods,  this  one  uses  the  direct 
technique  of  positioning  the  grasp  focus  at  specific  locations  to  obtain  a  desired  result.  In 
contrast  to  early  grasp  stability  studies,  focus  positioning  permits  the  in-depth  analysis  and 
thorough  undei  standing  of  the  effects  of  variables  required  for  grasp  analysis.  This,  in 
turn,  allows  the  study  of  broader  task  applications  and  general  solutions  using  existing 
manipulators. 

The  method  of  grasp  force  focus  positioning  was  first  introduced  by  Brock  [2], 
who  used  grasp  force  positioning  to  initiate  controlled  slipping  in  robotic  grasps.  The  goal 
was  to  enhance  the  object  manipulation  capabilities  of  a  robotic  hand.  The  method  was 
demonstrated  using  the  Salisbury  robot  hand.  The  three -fingered  hand  spun  a  cylindrical 
object  about  one  of  its  transverse  axes  by  altering  the  grasp  in  a  controlled  manner.  The 
grasp  allows  the  object  to  spin  by  using  gravity  as  the  inducing  force. 

The  concept  of  using  the  grasp  force  focus  for  grasp  analysis  can  also  be  found  in 
a  1991  publication  by  Yoshikawa  and  Nagai  [16].  The  purpose  of  this  paper  was  to 
propose  a  new  definition  of  grasping  and  manipulating  forces  for  multi-fingered  robot 
hands.  The  motivation  w'as  to  define  grasping  and  manipulating  forces  in  a  physically 
meaningful  way.  The  paper  defines  the  grasping  force  for  three  fingered  hands  as  an 
internal  force  that  satisfies  the  static  friction  constraint.  The  manipulating  force  r  ■  fined 
as  a  fingertip  force  that  satisfies  three  conditions:  1)  it  produces  the  specified  resultant 
force,  2)  it  is  not  in  the  inverse  direction  of  the  grasping  force,  and  3)  it  is  orthogonal  to 
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the  grasping  force  component.  The  results  of  the  study  are  used  to  develop  and  present  an 
algorithm  for  decomposing  a  given  fingertip  force  into  manipulating  and  grasping  forces. 

The  application  of  Brock’s  method  was  extended  to  include  the  joint  torque 
limitations  of  the  fingers  by  Edwards  in  1990  |3).  The  focus  placement  method  was 
explored  theoretically,  with  the  primary  effort  dedicated  to  single-finger  power  grasps  with 
one  contact  point  at  each  of  the  three  links.  Edwards  modelled  the  power  grasp  using  a 
single-finger  of  the  Utah/M  IT  Dexterous  Hand  (UMDH).  The  fundamental  difference 
between  Brock's  and  Edwards’  work  is  where  the  grasp  focus  is  placed.  Brock  places  the 
focus  in  an  area  which  produces  the  desired  type  of  slipping.  The  intent  of  Edwards’  work 
was  to  constrain  the  placement  of  the  grasp  focus  to  the  stable  region,  and  thus  avoid 
contact  slip. 

Edwards  graphically  developed  and  compared  constraint  maps  for  various  contact 
locations  based  upon  predefined  joint-torque  limitations.  Each  constraint  map  represents  a 
usable  region  for  force  placement  which  allows  a  stable  grasp  without  violating  joint- 
torque  limits.  Such  regions  were  defined  by  Edwards  as  "Safe  and  Stable"  regions.  The 
goal  was  to  determine  the  optimum  focus  location  for  a  three-point  power  grasp  of  a 
cylindrical  object  which  provides  the  manipulator  with  the  greatest  ability  to  exert  torque 
on  the  object.  Edwards  also  examined  the  effects  of  comact  location,  external  moment 
magnitude,  coefficient  of  friction,  and  cylinder  radius  on  the  safe  and  stable  region.  The 
results  demonstrated  that  optimal  focus  location  is  dependent  upon  contact  location,  joint- 
torque  limitations,  and  external  torque  direction. 

There  are  two  key  findings  from  Edwards’  research  which  are  incorporated  into 
this  study.  First,  Edwards  demonstrated  that  for  an  enveloping  three  point  grasp,  the 
optimum  focus  location  is  at  the  center  of  the  cylinder  13;p4-131.  In  addition  he 
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demonstrated  that  the  size  of  the  stable  region  will  remain  constant  if  the  ratio  of  external 
torque  to  grasp  force  magnitude  remains  constant  (3:p4-8]. 

Application  of  Edwards’  constraint  mapping  technique  to  the  goals  of  this  thesis 
requires  some  modifications.  The  primary  difference  lies  in  the  modeling  of  the  robotic 
hand.  The  requirements  call  for  a  general  hand  model  comprised  of  three  independently 
controlled  fingers,  as  opposed  to  one.  This  adds  a  significant  level  of  added  complexity. 
For  a  single-finge*'  power  grasp,  the  finger  joint  angles  are  fixed  and  the  object  does  not 
move  relative  to  the  hand.  Therefore,  the  safe  and  stable  region  remains  constant  since  the 
finger  joint  torques  are  constant.  Given  a  constant  cylinder  radius  and  coefficient  of 
friction,  the  safe  and  stable  region  is  only  a  function  of  contact  location,  contact  forces, 
and  joint  torque  limitations. 

This  study  models  a  three-finger  precision  grasp  of  the  cylinder  and  the  cylinder  is 
rotated  about  its’  longitudinal  axis.  Like  Edwards’  model,  the  grasp  must  also  oppose  an 
external  torque.  However,  with  a  precision  grasp  the  joint  angles  vary  as  the  cylinder  is 
rotated.  As  the  joint  angles  change,  so  do  the  joint  torques.  This  has  a  direct  effect  on 
the  safe  and  stable  region.  In  addition  to  cylinder  rotation,  the  joint  angles  are  also 
dependent  on  how  the  cylinder  is  positioned  with  respect  to  the  hand.  Therefore,  using  a 
precision  grasp  the  safe  and  stable  region  also  becomes  a  function  of  cylinder  position  and 
orientation. 

Unlike  Edwards’  thesis,  the  intent  of  this  study  is  not  to  determine  the  optimal 
grasp  focus  location.  Instead  it  is  to  understand  grasp  stability  behavior  in  the 
neighborhood  of  a  given  focus  point  in  the  safe  and  stable  region  as  the  object  is 
manipulated.  In  Edwards’  study,  the  safe  and  stable  region  is  reduced  to  a  single  point. 
This  point  corresponds  to  the  optimal  grasp  focus  location,  and  thus  the  maximum  torquing 
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capability  for  a  single-finger  power  grasp.  In  this  study,  it  is  assumed  that  the  actual 
position  of  the  desired  grasp  focus  may  vary  due  to  controller  errors.  Thus,  the  torquing 
capability  of  the  grasp  is  sub-optimized  to  achieve  a  specified  level  of  grasp  robustness. 

The  combination  of  object  manipulation,  joint-torque  limits,  and  constraint  mapping 
is  in  itself  the  "new"  area  of  study.  To  develop  a  grasp  planning  procedure,  the  study  uses 
the  method  of  grasp  force  focus  positioning  and  constraint  mapping.  This  method  is  used 
to  examine  various  grasp  configurations  by  varying  cylinder  position  and  orientation.  The 
different  grasp  configurations  are  then  compared  to  develop  general  relationships  for 
cylinder  position  and  orientation  with  respect  to  the  hand. 

1.4  Problem  Statement 

Develop  a  planning  procedure  for  grasping  and  manipulating  a  cylinder  using  a 
three-finger  precision  grasp.  Examine  a  manipulation  task  which  simulates  rotating  a 
cylinder  about  a  threaded  post  while  opposing  an  external  moment.  The  solution  must 
satisfy  the  following  grasp  requirements; 

a)  Use  a  single  grasp  configuration. 

b)  Insure  grasp  stability  and  robustness  over  a  specified  cylinder  rotation 
range. 

c)  Take  into  account  joint  torque  limitations  of  each  finger. 

d)  Provide  the  greatest  capability  to  oppose  external  moments  acting  on  the 
cylinder. 

The  resulting  grasp  planning  procedure  must  allow'  the  user  to  design,  a  three-finger 
precision  grasp  based  on  stability  criteria,  torquing  capability,  and  grasp  robustness. 
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1.5  Method  of  Approach 

This  study  examines  grasp  planning  through  the  development  of  a  three-fmgered 
model  of  an  existing  manipulator.  The  grasp  configuration  models  a  three  finger  precision 
grasp  of  a  cylindrical  object.  Point-contacts  are  assumed  for  each  finger  to  avoid  the 
complexities  of  rolling  contacts,  an  iTinecessary  complication  for  this  initial  study  of 
precision  grasps.  The  study  consists  of  two  sections:  1)  Inverse  Kinematic  Relationships 
and  2)  Grasp  Analysis.  The  final  step  is  to  incorporate  the  analytical  results  into  a 
computer  program  to  generate  the  appropriate  data  for  graphical  analysis. 

The  robotic  hand  model  used  in  this  study  is  based  on  the  Utah/MIT  Dexterous 
Manipulator  (UMDH).  This  hand  was  chosen  from  a  practical  standpoint  since  two  of 
them  are  used  at  AFIT  for  ongoing  research.  The  design  and  function  of  the  UMDH 
closely  resemble  that  of  the  human  hand.  This  convenient  aspect  allows  direct  comparison 
of  analysis  results  to  ones  own  hand  to  confirm  or  question  study  findings. 

The  kinematic  data  for  the  UMDH  is  documented  in  two  sources,  (17)  and  (18). 
The  key  information  for  computing  inverse  kinematic  relationships  is  the  coordinate-frame 
layout  of  each  finger  joint.  Of  the  two  cited  sources,  the  report  generated  by  MIT 
contains  the  most  complete  documentation  of  coordinate  frames;  therefore,  this  data  will  be 
utilized  in  the  ensuing  analysis. 

The  Denavit-Hartenburg  convention  is  applied  to  develop  homogeneous 
transformation  matrices  to  relate  fingertip  position  with  respect  to  the  "inenial  ’  or  palm 
frame.  The  fingertip  position  is  a  function  of  four  joint  variables.  The  base  Joint  of  each 
finger  permits  side-to-side  rotational  motion,  and  the  remaining  three  contribute  to  the 
curling  motion  of  the  finger.  For  a  point  contact,  there  are  only  three  unknowns; 
however,  each  finger  has  four  degrees  of  freedom.  The  fourth  degree  of  freedom  is 
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eliminalod  by  setting  the  rotation  angle  of  the  two  most  distal  joints  equal  to  each  other. 
This  results  in  a  curling  motion  similar  to  that  of  human  fingers. 

In  a  similar  manner,  the  transformation  matrix  w'hich  relates  object  position  and 
orientation  with  respect  to  the  palm  frame  is  determined.  The  object  variables  for  study 
are  proximity  to  the  hand  and  rotation  angle.  The  transformation  matrices  for  each  finger 
and  the  object  are  combined  to  form  the  three  finger  precision  grasp  model  for  finger-joint 
angle  determination. 

The  method  of  grasp  analysis  used  by  Edw  rds  [3]  is  applicable  to  this  study  since 
a  planar  grasp  is  employed.  Summarizing  the  method,  the  solution  for  the  contact  forces 
can  be  broken  into  two  parts:  1)  the  particular  solution,  and  2)  the  homogeneous  solution. 
For  this  project,  the  particular  solution  represents  the  contact  forces  at  each  contact  point 
required  to  balance  the  applied  or  external  moment.  The  homogeneous  solution  represents 
the  set  of  contact  forces  that  exert  no  net  force  or  moment  on  the  grasped  object.  ITie  set 
of  homogeneous  or  internal  contact  forces  has  an  infinite  number  of  possible  solutions. 

The  different  internal  grasp  force  solutions  can  be  resolved  through  the  use  of 
grasp  force  focus  positioning.  The  focus  position  will  uniquely  determine  the  solution  if 
the  grasp  force  magnitude  is  predetermined.  Mapping  of  all  focus  points  which  meet  grasp 
stability  and  joint-torque  criteria  will  result  in  a  usable  region  for  focus  positioning.  If 
joint-torque  imitations  are  ignored,  the  focus  or  "constraint"  map  will  be  made  up  of  focus 
points  which  meet  the  stable  no-contact-slip  criteria.  If  the  grasp  force  magnitude  is 
sufficiently  large,  this  region  is  reduced  in  size  once  joint-torque  limitations  are 
reintroduced. 

The  main  effort  will  involve  developing  set  of  computer  programs  to  determine 
how  the  safe  and  stable  region  changes  as  the  object  is  rotated  about  its  transverse  axis.  In 
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addition,  it  will  also  examine  how  this  region  changes  as  a  function  of  object  position  with 
respect  to  the  hand.  One  program  will  calculate  the  joint  angles  for  each  finger,  using 
inverse  kinematic  relationships,  for  a  given  object  orientation  and  position.  The  second 
program  will  use  this  data  as  input  and  calculate  the  data  required  for  constraint  mapping 
using  the  grasp  analysis  results.  The  constraint  maps  for  each  run  are  generated  using  a 
commercially  available  graphics  package. 

In  examining  the  change  in  the  safe  and  stable  region,  it  is  also  important  to  know 
which  finger-joint  violates  the  stable  area.  Therefore,  the  focus  mapping  program  will 
also  generate  joint-torque  boundary  lines  within  the  stable  region  for  each  joint  in 
violation.  With  this  feature  it  is  possible  to  determine  which  finger  joints  contribute  to  the 
violation  and  their  corresponding  relationship  to  object  position  and  orientation. 

To  examine  grasp  robustness  it  is  necessary  to  generate  constraint  maps  at  selected 
intervals  of  the  object  rotation  range.  The  intersection  of  all  constraint  maps  represents  the 
net  useful  safe  and  stable  region  for  object  manipulation.  Contact  location  is  also 
examined  to  determine  its  effects  on  the  net  region.  Stability  behavior  is  analyzed  by 
selecting  a  focus  point  within  the  net  region  and  determining  how  contact  forces  and  joint 
torques  are  effected  as  the  focus  deviates  from  the  location. 

The  final  step  is  to  determine  how  to  position  the  object  for  increased  torquing 
capability  and  grasp  robustness.  This  can  only  be  accomplished  after  establishing  the 
general  relationships  from  the  graphical  analysis.  Torquing  capabilities  are  examined  for 
full  and  partial  rotations  by  setting  the  stable  grasp  region  to  a  predetermined  size.  The 
size  of  the  region  directly  relates  to  a  constant  external  torque-to-grasp  force  ratio. 
Maintaining  a  constant  ratio,  the  external  torque  is  increased  until  the  point  at  the  cylinder 
center  no  longer  resides  in  the  net  region. 


In  summary,  the  approacti  is  to  use  the  method  of  grasp  force  focus  positioning  to 
complete  three  basic  steps.  The  first  step  is  to  examine  various  grasp  configurations  by 
varying  the  position  and  orientation  of  the  cylinder  with  respect  to  the  hand.  The  second 
is  to  develop  relationships  which  compare  the  different  grasp  configurations.  The  final 
step  is  to  use  these  relationships  to  design  a  robust  grasp  for  high  torque  applications. 

1.6  Contributions 

The  grasp  force  focus  positioning  method  permits  the  thorough  examination  of 
grasp  variables  and  their  effects  on  grasp  stability  and  robustness.  The  in-depth 
understanding  gained  by  using  this  method  provides  the  user  with  key  information  for 
g'asp  planning.  This  project  successfully  demonstrates  a  planning  procedure  for  robust 
grasp  design  using  a  three  finger  precision  grasp  of  a  cylindrical  object;  the  results  of 
which  complete  another  milestone  towards  demonstrating  intelligent  part  mating  skills  by 
the  AFIT  Robotics  Laboratory. 

By  using  a  generalized  '.ystem  model,  the  study  findings  are  applicable  to  similar 
grasping  tasks  currently  under  research.  The  model  can  be  easily  adjusted  to  represent 
other  existing  or  new  hand  designs  by  simply  changing  hand  dimensions  and  joint  torque 
limitations.  The  effectiveness  of  various  hand  designs  can  then  be  examined  for  specific 
task  applications  using  the  presented  planning  procedure.  The  versatility  of  the  procedure 
and  techniques  presented  provides  a  grasp  planning  tool  for  use  within  the  robotics 


community. 


1. 7  Organization 

Chapter  II  will  discuss  the  development  of  the  system  model  and  the  determination 
of  the  inverse  kinematic  relationships.  Chapter  III  summarizes  the  grasp  analysis  and 
grasp  force  focus  positioning  method  developed  by  Edwards  (3).  Modifications  to  the 
analysis  for  application  to  this  study  are  also  included.  A  description  of  the  two  computer 
programs  written  for  graphical  analysis  is  given  in  Chapter  IV.  Chapter  V  examines  the 
results  from  the  graphical  analysis  and  presents  examples  of  the  analysis  procedure  used. 
Study  conclusions  are  discussed  in  Chapter  VI.  Finally,  Chapter  VII  gives 
recommendations  for  use  of  these  results  and  suggestions  for  future  study  efforts. 


1-13 


II.  Model  Kinematics 


2. 1  Description  of  Hand  Model 

The  robotic  hand  model  configuration  presented  in  this  chapter  is  based  on  the 
Utah/MIT  Dexterous  Hand  (UMDH).  The  UMDH  is  a  right-handed,  four-fingered  (three 
fingers  and  one  thumb)  dexterous  hand.  Each  finger  of  the  hand  has  four  degrees  of 
fieedom  from  which  to  specify  fingertip  position  in  3-space.  The  hand  kinematic  data 
presented  herein  is  cited  from  a  report  generated  by  Narasimhan  117).  In  general,  the 
extracted  information  concerns  coordinate  frame  layouts  and  dimensions  for  the  UMDH. 

The  grasp  force  positioning  method  can  only  be  applied  to  three-point-contact  grasps 
since  the  solution  is  only  unique  for  this  panicular  application.  Therefore,  the  grasp 
analysis  requires  the  development  of  a  three  fingered  hand  model.  A  schematic  of  the 
three-fingered  hand  model  under  study  is  shown  in  Figure  2-1.  The  numbering  scheme  for 
each  finger  is:  a)  Thumb  -  Finger  0,  b)  Index  finger  -  Finger  1,  c)  Middle  finger  -  Finger 
2.  The  label  7^  represents  the  numbering  scheme  for  joint  i  on  finger  j.  This  type  of 
subscript  notation  also  denotes  specific  hand  coordinate  frame  axes  and  Joint  angles 
references  within  this  study. 

2.2  Hand  Model  Coordinate  Frames 

The  ease  of  determining  kinematic  relationships  for  a  robotic  hand  is  entirely 
dependent  on  proper  selection  of  coordinate  frames.  The  Denavit-Hartenburg  (D-H) 
notation  method  is  used  to  denote  the  Joint  coordinate  frames  for  each  finger.  The  labeling 
of  each  Joint  frame  is  depicted  in  Figure  2-2  and  Figure  2-3,  and  is  done  so  in  a  manner 
which  is  consistent  with  117:pU7). 
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Figure  2-1.  Schematic  of  Three-Fingered  Hand  Model 


Figure  2-2.  Joint  1  &  2  Layout  for  Three  Fingered  Hand  Model 


Figure  2-3.  Finger  Coordinate  Frame  Layout:  Xp-Zp  planar  view, 
positive  yp-axis  direction 

2.2.1  Palm  Frame.  The  palm  frame  {;rp,  yp,  Zp}  is  the  frame  to  which  all  other 
frame  positions  and  orientations  are  referenced.  The  palm  frame  is  located  directly  above 
Jqi  and  in  the  plane  containing  the  base  frame  origin  {jroj,  >'oj,  Zoj)  (1=0 A, 2)  for  each 
finger.  The  palm  frame  is  aligned  with  the  hand  such  that  the  Jp-  and  >p-axes  lie  in  the 
palmer  plane,  and  the  positive  Zp-axis  is  perpendicular  to  it  and  pointing  out. 

The  coordinate  frame  assignments  for  Finger  0  differs  from  those  for  Finger  1  and 
Finger  2  in  two  areas;  1)  the  location  and  orientation  of  the  base  or  zero  joints  (Jq^)  with 


respect  to  the  palm  frame,  and  2)  the  position  of  Joint  1  with  respect  to  the  base  joint. 
For  these  reasons  the  frame  assignments  for  Finger  0  are  addressed  separately  from  those 
for  Finger  1  and  Finger  2. 

2.2.2  Finger  0  Coordinate  Frames.  The  base  joint  of  Finger  0  is  located  a  distance 
RpQ  from  the  palm  frame  origin  as  measured  along  the  positive  Fp-axis.  The  base  joint 
rotates  about  the  ZQQ-axis,  which  is  parallel  to  the  palmer  plane  and  aligned  with  the  Xp- 
axis.  The  base  joint  frame  assignment  does  not  follow  the  conventional  D-H  method  and 
is  treated  as  an  intermediate  coordinate  frame.  The  relation  between  the  base  joint  for 
Finger  0  and  the  palm  frame  is  expressed  as  117;pl22). 

TransQ,’p,  Rpq)  Rot(yp,ir/2)  Rot{z’,  ir) 

where  RpQ  for  Finger  0  is  0.695  inches,  and  2’  denotes  the  2p-axis  after  the  rotation  about 
the  >p-axis.  The  homogeneous  transformation  or  A  matrix  relating  the  position  and 
orientation  of  the  base  joint  frame  to  the  palm  frame  is: 

0  0  1 

0-10 
10  0 
0  0  0 


0 

1 


(2.1) 


Joint  1  (J^q)  is  positioned  a  distance  Hq  above  the  base  joint  as  measured  along  the 
positive  jfQo-axis.  The  value  of  Hq  in  the  analytical  model  is  equal  to  0.4  inches.  Joint  1 
of  Finger  0  rotates  about  the  2|o-axis,  which  is  parallel  to  the  palmer  plane  and  in  the 
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direction  of  the  negative  >'p-axis.  This  joint  and  the  remaining  joints  on  Finger  0  follow 
the  D-H  frame  assignment  convention  from  which  the  A  matrices  can  be  derived  from  tlie 
standard  D-H  matrix: 


‘'ifl 

^6 

®i0 

-C.  s 

Og)  «/ 

(2.2) 

0 
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0 

0 

0 

1 

where  Qio  denotes  cos{6^q),  ^eiQ  denotes  sin{0^Q),  and  i  designates  the  joint  number. 


The  A  matrix  relating  the  position  and  orientation  of  the  Joint  1  frame  of  Finger  0  to 
its’  base  joint  frame  is: 


H^cosdgo 

Hjsindog 
0 
1 

where  is  the  variable  joint  rotation  angle  for  Joint  1. 
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The  frame  assignments  for  the  remaining  three  joints  on  Finger  0  correspond  to 
simple  revoluie  axes.  All  three  joint  rotation  axes  are  parall  and  are  perpendicular  to 
the  plane  of  finger  movement  termed  the  operational  plane  117:pl20].  Each  joint  rotates 
about  its’  z-axis  which  is  perpendicular  to  the  z,o-axis  of  the  base  joi  The 
corresponding /I  matrices  for  each  joint  are: 


cosOjo 

-sindjo 

0 
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where  0jQ  is  the  variable  joint  rotation  angle  for  Joint  i  on  Finger  0.  For  the  hand  model  /[ 
is  1.7  inches  and  A  is  1.3  inches,  where  /  is  the  length  of  each  finger  appendage.  The 
term  represents  the  distance  from  Joint  3  to  the  fingertip,  and  is  set  to  a  value  of  0.735 
inches  for  the  hand  model. 

Since  the  model  assumes  point-contacts,  /j  is  also  the  constant  distance  to  the  contact 
point  on  the  object.  In  a  more  general  application,  the  contact  point  would  be  represented 
by  an  additional  coordinate  frame  and  separated  from  the  fingenip  frame  by  a  variable 
length  /c  and  variable  angle  0.  The  D-H  parameters  for  Finger  0  are  summarized  in  Table 
2-1. 

Given  the  A  matrices  for  each  joint,  the  transformaticii  matrix  relating  the  position 
and  orientation  of  the  fingertip  frame  {Ar5o,  Vso.  ^50}  o  i  Finger  0  with  respect  to  frame  n  at 
y„o  (where  n  <  5)  is  given  by: 
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(2.7) 


Using  Equation  2.7,  the  transformation  matrix  relating  the  position  and  orientation  of  the 
fingertip  frame  on  Finger  0  to  >',o,  2jo}  is: 
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and  the  transformation  matrix  relating  the  position  and  orientation  of  the  fingertip  frame  on 
Finger  0  to  its’  base  joint  frame  {xnQ,  >20,  ^20}  ^ 


^123.0 

~^I23.0 
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123.0  h^i2.o  ^1^10 

^123.0 

^123.0 
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2.2.3  Finger  1  and  Finger  2  Coordinate  Frames.  The  origins  of  the  base  joint 
frames  on  Finger  1  and  Finger  2  are  equally  positioned  below  the  palmer  plane  and  in  the 
yp-Zp  plane  of  the  palm  frame.  The  coordinate  frames  of  both  joints  are  aligned  such  that 


Table  2-1.  D-H  Parameters  for  Finger  0 
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*  variable  joint  angle  /  for  Finger  0 


their  x-axes  are  parallel  to  the  palmer  plane  and  in  the  direction  of  the  positive  yp-axis.  In 
addition,  both  frames  are  rotated  counterclockwise  about  their  respective  x-axes  by  a  fixed 
angle  The  base  joint  of  Finger  1  resides  along  the  negative  Zp-axis  and  the  base  joint 
of  Finger  2  is  separated  from  it  by  a  fixed  distance  Rp2,  as  measured  along  the  positive 
Xjj-axis.  The  base  joint  of  Finger  1  and  Finger  2  rotates  about  the  Zi|-axis  and  Zj^-axis, 
respectively.  Like  the  base  joint  for  Finger  0,  both  of  these  base  joint  frame  assignments 
do  not  follow  the  conventional  D-H  method  and  are  treated  as  intermediate  coordinate 
frames.  The  relation  between  the  base  joint  for  Finger  k  (A:=l,2)  and  the  palm  frame  is 
expressed  as  (I7:pl  18|: 

Trans(yp,  Rp^J  Trans{zp,  lpian<pp  -  Hp)  /?or(>’p,7r/2  -i-  <pp)  Roi{z’,  t^/I) 

where  z'  denotes  the  Zp-axis  after  the  rotation  about  the  yyaxis,  and: 

/?Pi  =  0  inches  Hp  =  0.95  inches 

Rp2  =  1.39  inches  (Pp  =  12  degrees 

Ip  =  1.05  inches 
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It  should  be  noted  that  the  value  chosen  for  Rp2 's  different  than  that  in  [17).  The 
actual  value  of /?p^  in  [17:pl  19]  is  equal  to  1.42  inches.  For  this  study  Rp2  ®9ual  to 
twice  that  of  RpQ  so  that  the  positioning  of  base  joint  yoi  702  symmetric  about  the 
base  Joint  for  Finger  0.  The  intent  is  to  minimize  asymmetrical  properties  in  the 
forthcoming  analysis. 

The  A  matrix  for  Finger  1  or  Finger  2  relating  the  position  and  orientation  of  base  joint 
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where  /:  =  1 ,  2 

The  first  link  (Iq)  of  Finger  1  or  Finger  2  makes  a  fixed  angle  <pq  with  the  c-axis  of 
rotation  at  the  base  joint.  For  the  hand  model,  <fiQ  equals  30  degrees  and  Iq  equals  1.2 
inches.  The  A  matrix  for  Finger  1  or  Finger  2  relating  the  position  and  orientation  of  the 
Joint  1  frame  to  its  base  frame  is: 

cos6qi^  0  -smdgi^ 

sind^^.  0 

'^2  = 

0  -10 
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l^SitKp^COSdg^ 

l^inip^sindo, 
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^lcos<p^ 
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(2.11) 


where  k  =  \2  and  0,^  is  the  variable  joint  angle  for  Joint  1  on  finger  k 
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Since  the  remaining  frame  assignments  for  both  Finger  1  and  Finger  2  are  identical 
to  those  for  Finger  0,  the  form  of  the  corresponding /I  matrices  is  also  the  same. 

Therefore,  the  A  matrices  represented  by  Equations  2-4,  2-5,  2-6  and  2-9  apply  to  Finger  1 
and  Finger  2  with  the  appropriate  change  of  joint  angle  subscripts.  The  D-H  parameters 
for  Finger  1  or  Finger  2  are  summarized  in  Table  2-2. 

Using  Equation  2.7  the  transformation  matrix  relating  the  position  and  orientation 
the  fingertip  frame  on  Finger  k  to  coordinate  frame  {.tij;,  yj^,  is: 
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where  k  =  1,2,  and  subscripts  123, k  and  72,/:  denotes  (^ik+^2k'''^3i<) 
respectively. 

2. 3  Cylinder  Coordinate  Frames 

The  final  step  in  the  system  modeling  task  is  the  frame  assignments  for  the  cylinder. 
The  goal  is  to  select  a  framework  configuration  which  permits  variations  of  cylinder 
proximity  and  orientation  with  respect  to  the  hand.  As  before,  the  palm  frame  is  the  frame 
of  reference.  The  frame  assignments  for  cylinder  position  with  respect  to  the  palm  frame 
are  shown  in  Figure  2-4.  These  frame  assignments  allow  the  body  to  be  moved  towards 
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or  away  from  Finger  0,  and  held  in  close  to  or  extended  away  from  the  palm.  The  frame 
assignments  also  allow  for  the  rotation  of  the  cylinder  centerline  about  the  Vp-axis. 

The  first  frame  is  positioned  a  distance  /?(,  from  the  palm  frame  origin,  as  measured 
along  the  positive  Vp-axis.  The  value  of  is  set  to  0.695  inches,  which  is  equal  to  /?po. 
This  particular  value  provides  for  model  symmetry  about  the  x-z  plane  of  base  joint  on 
Finger  0.  That  is,  the  cylinder  centerline  resides  in  the  x-z  plane  of  JOO,  and  JIO  and  J20 
are  symmetrically  positioned  about  this  plane  (reference  Section  2.2.2  and  Figure  2-1). 

The  origin  of  Frame  2b  is  coincident  with  the  Frame  lb  and  the  x^b-axis  is  aligned  with 
the  y,b-axis.  The  frame  is  rotated  clockwise  about  the  jr^t-axis  by  an  angle  such  that 
the  pointing  towards  Finger  1  and  2.  The  third  frame  is  displaced  from  Frame 

2b  by  a  variable  distance  dj,  and  Frame  4b  is  positioned  a  variable  distance  from  Frame 
3b.  The  cylinder  is  aligned  with  Frame  4b  such  that  its  centerline  is  along  the  Z4b-axis  and 
the  cylinder  contact  plane  is  coincident  with  the  .r4b-y4b  plane. 

The  frame  assignments  for  cylinder  orientation  and  contact  position  are  shown  in 
Figure  2-5.  The  body  frame.  Frame  B,  is  fixed  to  the  cylinder  center  and  rotates  about 
Frame  4b  by  a  variable  angle  <^>b  The  contact  frame  origins  are  located  at  the  cylinder 
surface,  an.i  are  rotated  from  the  fl„-axis  by  a  fixed  angle  (j=0.1,2).  The  subscript  for 
contact  frame  Cg.  C,,  and  C2  corresponds  to  the  contact  made  by  Finger  0,  Finger  1,  and 
Finger  2,  respectively.  The  cylinder  radius  r^.  is  set  to  1.0812  inches  for  the  study  model. 

The  D-H  parameters  for  the  cylinder  are  summarized  in  Table  2-3.  The  /.  matrices 
for  each  of  the  cylinder  coordinate  frames  are: 

0  0  10 

®  ®  (2.13) 

10  0  0 

0  0  0  1 


2-11 


2-12 


Figure  2*5.  Position  &  Orientation  of  Contact  Frames 


Table  2-3.  D-H  Parameters  for  Cylindrical  Object 
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where  CJ  denotes  contact  j.  j  =0,  1,2 
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Using  Equation  2,7,  the  homogeneous  transformation  matrix  relating  the  position 
and  orientation  of  each  contact  with  respect  to  the  palm  frame  is  given  by; 
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where  subscript  Cj  denotes  contact  j, ;  =  0,  1 ,  2 


2.4  Inverse  Kinematic  Relationships 

The  inverse  kinematic  relationships  for  the  system  model  are  easily  determined  from 
the  A  matrices  for  the  hand  and  cylinder.  The  first  step  is  to  determine  the  3-space 
coordinates  of  each  contact  location  in  terms  of  the  paim  frame  coordinates.  Note  that  this 
assumes  that  the  cylinder  position  and  orientation  with  respect  to  the  palm  frame  is  known 
in  advance.  From  Equation  2, 19  the  scaler  3-space  contact  positions  written  in  palm  frame 
coordinates  is  given  by; 


%  =  -d^S,^  -  C^idj  -  r^S(<p^*i/r^)) 

%  =  (2.20) 

=  d,C^^  +  S^idj  -  r^Sdp^-^Ktj)) 
where  Cj  denotes  contact  j,j  =  0,  1,2 
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To  solve  for  the  inverse  kinematic  equations,  it  is  necessary-  to  convert  the  x,  y,  z 
contact  positions  as  expressed  in  the  palm  frame  to  the  appropriate  joint  frame.  The 
general  equation  to  convert  the  3-space  position  of  Coniaa  J,  as  written  in  palm  frame 
coordinates,  to  the  local  cartesian  coordinates  zx  Joint  n  {n  =  \,2)  on  Finger  j  (/' =0,1,2)  is 
given  by; 


"V 

nv 

II 

% 

^cj 

^  1  , 

1  1 

(2.21) 


where  C,  denotes  contact  frame  j,  and  n  denotes  frame  n  on  Finger  j. 

Using  Equation  2.21  the  cartesian  coordinates  of  Contact  0  written  in  coordinate 
frame  {atiq,  >jo.  ^lo}  located  on  Finger  0  is: 


lOy 
^CO  “ 

^co 

lOy 
•“CO  ~ 

(2.22) 

IO7 
^CO  ~ 

%o 

An  issue  to  resolve  before  proceeding  with  the  solution  for  each  Joint  angle  is  the 
possibility  of  multiple  joint  angle  solutions.  Multiple  joint  angle  solutions  are  possible  for 
each  finger  of  the  hand  model  by  positioning  any  two  adjacent  finger  links  in  an  elbow-up 
or  elbow-down  configuration.  Proper  selection  of  artificial  constraints  on  the  last  three 
joints  of  each  finger  will  avoid  this  problem  entirely.  Since  the  design  of  the  UMDh 
naturally  restricts  adjacent  links  to  only  one  possible  configuration,  similar  constraints  can 
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be  applied  to  the  hand  model.  Joint  rotation  limits  for  each  finger  in  the  hand  model  in 
presented  in  Table  2-4.  The  joint  limits  imposed  are  based  on  actual  measurements  of 
corresponding  joints  on  the  UMDH. 

With  the  contact  position  written  in  the  base  joint  of  Finger  0,  the  joint  angle  ^00 
from  the  geometric  relation; 


^00  = 

The  final  step  is  to  solve  for  the  three  remaining  joint  angles  for  Finger  0  (0jg,  O-^q, 
Ojq)  in  terms  of  contact  position  and  0qq.  However,  locating  the  fingertip  at  the  contact 
location  is  a  3  degree  of  freedom  task;  therefore  one  of  the  remaining  finger  joint  angles  is 
redundant.  This  problem  exists  for  all  three  fingers,  since  each  one  has  four  joints.  One 
method  to  resolve  this  redundancy  for  each  finger  is  to  specify  a  general  equation  of 
constraint  on  the  last  two  distal  joints: 


e,j  ^  K  X  By  (2.24) 

where  A:  is  a  proportionality  constant,  and  0-  is  the  joint  angle  i  for  Finger  j,j  =  0,  1.  2. 

The  result  of  this  approach  is  similar  to  the  joint  angle  rotation  of  the  last  two  distal 
joints  on  a  human  finger  |17:p29).  Tu  solve  for  the  remaining  joint  angles  on  Finger  0  it 
is  first  necessary  to  transfer  the  cartesian  coordinates  of  Contact  0  to  the  local  coordinate 
frame  {atiq,  >20-  ^20}- 


2-17 


Table  2-4.  Joint  Angle  Limits 


Joint  Rotation  Limit  (degrees) 

Joint 

Finger  0 

Finger  1 

Finger  2 

0 

-45  to  45 

1 15  to  65 

115  to  65 

1 

-60  to  15 

-60  to  1 1 

-60  to  1 1 

2 

-90  to  6.5 

6.5  to  90 

6.5  to  90 

3 

-90  to  0 

0  to  90 

0  to  90 

^co 

W 

^  CO 

-  'z 

^co 

(2.25) 

*2  = 
^co 

Given  the  3-space  position  of  the  contact  and  noting  that  the  three  remaining  joint 
axes  are  parallel  to  one  another,  the  solution  for  three  Joint  angles  is  a  simple  geometry 
problem.  From  Equation  2.8,  the  X  and  Y  position  components  of  Contact  0  written  in  the 
{■^20’  >':o'  frarne  can  also  be  expressed  as: 


^Xco  =  l,cosd,o  +  l^COSidjg^djf,)  + 

^Yco  =  liSindjg  *  +  l,sin(djg*  O^g) 


(2.26) 


The  value  of  K  in  Equation  2.24  is  set  to  1,  such  that  djQ  =  d-,Q,  to  simplify  the 
solution.  Squaring  Equation  2.26  ani  using  the  cosine  double  angle  identity,  the  equation 
reduces  to  a  quadra'ic  form  in  terms  of  02o 
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(2.27) 


The  solution  of  which  is; 


''20 


=  arctanf 


D 


(2.28) 


where 


-21,(1,  *1, 

) 

4/2  (/;W/ 

‘/‘2 

8 


Note  the  minus  sign  before  the  radical  in  Equation  2.29  corresponds  to  the  elbow-up 
configuration  for  Finger  0  (reference  Figure  2-3). 

Finally  the  solution  for  the  last  joint  angle  on  Finger  0  is  given  by: 


d 


10 


arctan 


1 

^  CO 

-  arcun 

2y 

^co) 

\ 

*  l^COSiO^O*  IjCOSddjo) 


(2.29) 


Applying  the  same  Joint  angle  solution  method  to  Finger  1  and  Finger  2  only 
requires  a  change  to  the  coordinate  transformations  from  the  palm  frame  to  the  appropriate 
finger  Joint  and  a  change  of  subscripts.  Since  the  kinematic  structure  of  both  fingers  are 
identical,  the  ensuing  equations  apply  to  both.  Using  Equation  2.21  the  cartesian 
coordinates  of  Contact  k  written  in  base  Joint  coordinate  frame  {Xi^,  for  Finger  k 

ik=  1 ,2)  is: 
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(2.30) 


Ity  -  Pi. 

^Ck  ~  ^Pk  ■'C* 

=  HpCos<pp  +  ^X^i^sin^p  +  ^Zf-j^coSipp  -  Ipcoscpptan^p 
=  ^X^yCosipp  -  ^Z(.^intpp  -  HpSinipp  +  lpSin<Pptan<Pp 


and  the  cartesian  coordinates  of  Contact  k  written  in  coordinate  frame  {x2i(,  >’21,;,  22k} 

Finger  k  is; 

^^ck  =  '%iCosdoy  +  '%tSindoy  -  l^sirnp^ 

^^ck  =  ic^os<p^  *  — - - “‘Zcy  (2.31) 

COS<pp 

^^Ck  =  -  ^  '‘‘^Ck<^OS^0k 


Using  Equation  2.30,  the  solution  for  is  given  by  (2.23)  with  the  appropriate 
subscript  changes.  Similarly,  the  solution  for  is  given  by  Equation  2.29  using 
Equation  2.31.  The  solution  for  's  similar  in  form  to  Equation  2.28.  By  changing  the 
sign  before  the  radical  to  a  positive  to  account  for  the  elbow  down  configuration  of  Finger 
k.  Equation  2.28  can  be  used  to  solve  for  02k-  The  equation  for  D  in  Equation  2.28  is  still 
valid  using  Equation  2.31. 

2.5  Model  Application 

The  inverse  kinematic  equations  from  Section  2.4  form  the  basis  to  determine  finger 
joint  angles  as  a  function  of  cylinder  position  and  orientation.  The  inverse  kinematic 
analysis  for  this  project  consists  of  using  a  Sun  computer  workstation  to  run  a  Fortran 
program  which  incorporates  the  model  equations.  The  input  to  the  program  consist.*;  of 
specific  values  for  contact  location,  cylinder  position  and  orientation,  and  cylinder  rotation 


2-20 


increment.  With  this  data  the  program  will  output  the  resulting  joint  angles  for  each 
specified  rotation  increment  and  determine  the  allowable  maximum  rotation  range  of  the 
cylinder.  The  definition  of  the  allowable  rotation  range  is  simply  the  resulting  rotation 
range  which  does  not  violate  any  of  the  joint  angle  limits. 

There  are  two  additional  features  which  the  program  provides  as  output.  The  first  is 
the  specification  of  the  angle  which  the  last  finger  link  (/^)  makes  with  the  cylinder  contact 
plane.  The  program  output  provides  this  data,  termed  f.ngenip  grasp  angles  or  simply 
"grasp  angles",  for  each  of  the  three  fingers.  This  data  is  useful  since  it  indicates  where 
the  contact  point  is  relative  to  the  fingertip.  A  negative  grasp  angle  corresponds  to  a 
contact  location  on  the  topside  or  "fingernail"  portion  of  the  fingertip.  A  positive  grasp 
angle  corresponds  to  a  contact  location  on  the  underside  of  the  fingertip.  This  is  a 
desirable  contact  location  since  on  actual  robotic  hands,  this  area  is  typically  covered  with 
a  slip-resistant  coating  and  may  also  house  contact  sensors. 

The  second  feature  of  the  program  is  the  output  of  joint  angle  data  for  each  finger, 
corresponding  to  a  specific  cylinder  rotation  angle.  This  discrete  rotation  angle  is 
specified  as  an  input  parameter  and  the  resulting  data  is  sent  to  an  external  data  file.  The 
next  chapter  develops  grasp  and  torque  equations  for  inclusion  in  a  grasp  force  focus 
mapping  program  which  uses  the  joint  angle  data  file  as  one  of  its  inputs. 

The  inverse  kinematics  program  utilizes  five  input  parameters  to  specify  cylinder 
position  and  orientation:  1)  contact  location  ’/'i-  ’/'a)*  2)  discrete  cylinder  rotation 
angle  3)  cylinder  proximity  (d^).  4)  cylinder  bias  {d^),  and  5)  cylinder  tilt  angle  (a^). 
A  sixth  input  parameter  specifies  the  cylinder  rotation  increment.  The  cylinder  bias 
parameter  refers  to  positioning  or  biasing  the  cylinder  towards  Finger  0  or  towards  Fingers 


1  and  2. 


Of  the  six  input  parameters,  the  only  parameter  which  is  not  variable  is  the  cylinder 
tilt  angle  One  of  the  objectives  of  this  project  is  to  determine  the  effects  of  joint 

torque  limits  on  the  grasp  focus  as  a  function  of  cylinder  position  and  orientation.  In 
doing  this,  it  is  desirable  to  maximize  the  range  of  the  cylinder  position  parameters  £^3  and 
d^.  These  two  parameters  have  the  greatest  effect  on  the  size  of  the  torque  "moment  arm” 
for  each  joint.  There  are  two  items  which  bound  the  range  of  dy  and  joint  angle  limits 
and  finger  length. 

Although  not  intuitively  obvious,  there  is  a  specific  value  for  which  maximizes 
the  range  of  d-^  and  d^.  The  determination  of  this  value  is  simple  since  each  of  the  fingers 
in  the  hand  model  are  of  the  same  length  and  have  identical  joint  rotation  ranges  for  the 
two  most  distal  joints.  The  joint  rotation  ranges  can  be  derived  from  the  corresponding 
joint  angle  limits  (Table  2-4).  In  addition,  the  base  joint  and  Joint  1  locations  for  Fingers 
1  and  2  are  equally  positioned  from  the  corresponding  joints  on  Finger  0.  In  short,  the 
value  of  Q[j,  IS  equal  to  the  angle  formed  by  a  plane  parallel  to  the  palm  and  the  plane 
formed  by  Joint  I  of  each  finger  (Figure  2-6).  The  resulting  value  of  is  24.0777 
degrees. 

With  the  cylinder  oriented  at  this  particular  value,  the  distance  from  Joint  1  to  the 
contact  plane  is  equal  for  each  of  the  fingers.  In  addition  there  is  a  unique  value  for  d^ 
over  the  range  of  d^  at  which  the  contact  angles  for  each  of  the  fingers  are  equal.  At  this 
setting  the  absolute  value  of  the  two  distal  joints  of  each  finger  are  equal  and  the  cylinder 
position  is  "neutrally"  bias.  With  the  cylinder  in  a  neutrally  bias  position,  the  range  of  £^4 
is  at  a  maximum.  Changing  the  value  a^,  reduces  the  ranges  of  d-^  and  d^  since  one  of  the 
fingers  will  bind  before  the  others  due  to  the  joint  angle  limits. 
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Figure  2-6.  Cylinder  Tilt  Angle  Of, 


In  summary,  the  inverse  kinematics  program  can  be  used  to  calculate  finger  joint 
angles  for  various  cylinder  positions  and  orientations.  Different  combinations  of  the  five 
variable  model  parameters  can  be  used  to  analyze  the  effects  of  joint-torque  limits  on  the 
grasp  focus  region,  once  the  grasp  analysis  is  complete.  The  selection  of  specific  values 
for  each  variable  will  be  discussed  in  Chapter  IV. 


III.  Grasp  Analysis 


3. 1  Grasping  Forces 

A  three  fingered  precision  grasp  presents  a  special  case  for  grasp  analysis  since  all 
three  contacts  lie  in  a  plane.  Constraining  the  external  forces  to  this  plane  further 
simplifies  the  analysis.  This  is  the  case  for  this  project  since  the  only  external  force  for 
inclusion  in  the  analysis  is  an  applied  moment  acting  about  the  cylinder  centerline.  The 
grasping  analysis  presented  by  Edwards  13:p2-l  to  2-1 1)  is  applicable  to  this  study  and  is 
summarized  in  the  following  sections  for  completeness. 

The  grasp  analysis  begins  by  first  examining  the  general  relationship  between  the 
contact  forces  and  moments  exerted  on  the  object  by  the  fingers,  and  the  external  forces 
and  moments  applied  to  the  object  by  the  environment.  If  the  contact  forces  and  moments 
(represented  by  c  )  cause  a  static  balance  with  the  external  forces  and  moments 

(represented  by  F  ),  then  the  grasp  matrix  W  relates  the  two  vectors. 

F  =  WF 

where  W  depends  on  the  grasp  configuration. 


Given  F  and  W  it  is  possible  to  find  a  solution  for  c  by  using  the  pseudo-verse  of 

W  (W").  If  the  general  solution  is  not  unique,  the  solution  of  c  is  the  sum  of  a  particular 
solution  and  a  homogeneous  soli'tiofi. 
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(3.2) 


where 

c  =  W*  F 

p 

c,^=NX  (3.4) 

The  term  N  in  Equation  3.4  is  a  matrix  whn'-e  columns  are  orthonormal  vectors  that 
span  the  null  space  of  IV,  and  X  is  a  vector  of  aruit;.  ‘y  magnit  des.  The  homogeneous 
solution  (Equation  3.3)  represents  the  internal  g.asping  forces.  The  particular  solution 
(Equation  3.4)  represents  the  additional  force  to  balance  the  external  forces  acting  on  the 
object. 

3. 2  The  Contact  Force  Particular  Solution 

For  this  project  is  a  vector  composed  of  the  tangential  forces  at  each  contact 

which,  as  a  whole,  balance  the  external  moment  about  the  cylinder  centerline  (B^-axis)  as 
shown  in  Figure  3-1.  This  constrains  the  solution  such  that  ~  ^ 

forces  are  constrained  to  the  contact  plane,  all  forces  perpendicular  to  it  equal  zero. 
Specifying  that  the  solution  to  c^  must  also  balance  external  forces  in  the  5^-  and  By¬ 
directions  implies  that  E^bk  ~  ^  Applying  the  three  constraints  (E^^bz 

=  0,  r^Bx  ~  0,  and  E^Bv  ~  0)  in  matrix  form  results  in  an  equation  in  terms  of  the 
tangential  forces  at  each  contact  and  their  respective  contact  angles  \p. 
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Figure  3-1.  Balancing  the  External  Moment  I3:p2-2J 


COSl/fg  COS^J  COSlfTj 

= 

sinil/g  sin^j  sini/fj 

1 

1 

The  objective  of  this  project  only  concerns  how  to  balance  an  external  moment  on 
the  cylinder;  thus,  the  external  forces /0^,  and /g^  are  zero.  Since  the  matrix  in  Equation 
3,5  is  square,  Gaussian  elimination  yields  the  solution; 
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= 


B,B, 


B.  B^  -  B, 

X.  =  -LJ - LJL 

fi.  B. 


'1"4 


(3.6) 


where 

B,  = 

Bj  =  -  cos  If/ j 

Bj  = 

B^  =  sin(if/2-iffj)  + 

B.  - - ^C05»|r. 

'’c 

"’at 

B^  =  -^  co^V'o 

B7  =  -^siniif/g-if/,) 


(3.7) 


Therefore  given  a  moment  /ng,  on  a  cylinder  of  radius  r^,  the  solution  for  the  contact 
forces  required  to  balance  the  moment  can  be  determined  if  the  contact  angles  are  known. 


3.3  The  Internal  Grasp  Force  Focus 

The  internal  grasp  forces  exert  no  net  forces  or  moments  on  the  cylinder.  If  a  line 
is  extended  in  both  directions  along  the  internal  force  vector  at  each  contact  point,  the 
three  lines  will  meet  at  a  unique  point;  assuming  the  contact  points  are  not  collinear.  This 
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point  is  termed  the  grasp  force  focus  (2] [3).  Although  the  internal  force  vectors  define  the 
grasp  focus,  a  unique  homogeneous  solution  cannot  exist  until  the  magnitudes  of  the 
internal  grasp  forces  are  specified.  Using  Brock’s  and  Edwards’  definition,  the  internal 
grasp  force  magnitude  is  given  by: 


m 


t 


-f 


(3.8) 


where  the  subscript  /  denotes  internal  forces. 

3.4  The  Homogeneous  Solution 

For  a  three  point  planar  grasp  there  are  six  internal  force  components;  thus,  six 
independent  constraint  equations  are  required  to  uniquely  determine  the  homogeneous 
solution.  The  first  three  constraints  are  inherent  in  the  definition  of  the  internal  grasp 
forces  (IA/bz  =  “  0-  I^By  =  0).  Specifying  the  grasp  force  magnitude  in 

Equation  3.8  provides  a  fourth  constraint. 

Three  more  constraints  are  derived  from  the  condition  that  the  internal  force  vector 
at  each  contact  must  lie  along  a  line  through  the  corresponding  contact  point  and  the 
prescribed  grasp  focus.  The  grasp  plane  coordinates  (x^,  y^)  define  the  position  of  the 
grasp  focus  within  the  contact  plane,  as  shown  in  Figure  3-2.  Translating  the  components 
to  local  contact  frame  coordinates  yields  the  three  constraint  equations: 

ix^sintl/j-y^cosif/j-r^)Xj^  +  {x^cosif/j^y^smij/j)  =  0  ;  =0,1,2  (3.9) 
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Figure  3-2.  Prescribing  the  Grasp  Force  Focus  Location  13;p2-6J 


Combining  Equations  3.6  and  3.9  in  matrix  form  revels  that  only  five  of  the  six 
equations  are  independent.  The  remaining  five  equations  are  sufficient  to  solve  for  five  of 
the  force  components  in  terms  of  l^y  The  resulting  five  expressions  are  substituted  into 
Equation  3.8  to  solve  for  Equation  3.10  shows  how  back  substitution  is  then  used  to 
obtain  solutions  for  the  other  five  force  components. 


s 


\  \ 
^0,  = 

^1,  = 

2.,  =  ty,z,^ 

^2,  =  ^5^2, 


(3.10) 


where 

W,  = 

y^ 

^,<?3^4 

!♦',  = 

^'2 

P,P, <?,/?. 

= 

f^4 


K 

P,R, 

^10 

>9 


where 

V,  =  t/,/*, -(/,/’, 0 
V,  =  (/,/',  - 


V,  -  U,F,  -  U,P,, 

V^  =  R^Pg  -  R^Pio 


where 

^1  "  ^3^4  ”  ^5^4  '*’  ^4^5 
^2  "  ^4^6  ”  ^6^4 

t/3  =  R,R,  -  R,R, 


1/4  -  R^R^  -  R^Rf 

=  <?5^4  -  <?4/?, 
^6  =  <?6^  -  <?4/?6 
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where 


<?.  =  ^3-^. 

<?2  =Ps-Pi 

<?3  =  PA^PA-Pl-Pi 

where 

P^  =  -costffg 
Pi  =  sinii/g 
Pj  =  -cos  Ip  J 
P^  =  5m 

Pj  =  -cos  If,  2 


<?4  =  ^4^,  -  ^3^2 

O5  =  P6^2  ^1^5  '  P2  -  PI 

Q,  =  PA  -  P5P2 

Pi  =  simp 2 

P,  =  x^inpj  -y^cospj  * 

Pg  =  x^cosip2*y^inip2 
P9  =  -ytCosp2  *r^ 

Pio  =  x^cosip2^y/inp2 


Substituting  for  all  of  the  parameters  will  yield  expressions  for  the  six  internal 
contact  force  components  in  terms  of:  r^,  \pQ,  ^2.  ^g.  and  m^.  Given  the  cylinder 

radius,  contact  locations,  and  grasp  force  focus  location  and  magnitude,  a  unique  solution 
for  the  internal  grasp  forces  can  be  determined  using  Equation  3.10. 


3.5  Constraints  on  Total  Contact  Forces 

The  complete  solution  for  the  contact  forces  is  the  vector  sum  of  the  particular  and 
homogeneous  contact  forces.  The  general  equation  for  the  six  components  of  force 
expressed  in  local  contact  coordinates  is; 


X.  =  X 


Jr 


Jr 


y =0.1,2 


(3.11) 
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where  the  subscript  T denotes  the  total  contact  force  component. 


There  are  two  criteria  to  impose  for  maintaining  grasp  stability.  The  first  is  that  the 
fingertip  cannot  break  contact  with  the  cylinder;  this  implies  that  the  normal  contact  forces 
must  be  positive.  The  second  criteria  is  that  the  tangential  force  at  each  contact  must  be 
less  than  the  maximum  forces  sustainable  by  static  friction. 

Table  3-1  lists  the  three  types  of  contacts  which  result  from  the  two  contact  criteria. 
Of  the  three,  only  contact  type  1  meets  both  requirements.  Thus  the  desirable  solution  for 
contact  forces  will  result  in  contact  type  "1"  at  each  of  the  three  contacts.  The  contact 
types  for  the  three  contacts  can  be  arranged  sequentially,  starting  with  Contact  0,  in  a 
three-digit  code  such  as  "312". 

3.6  The  Constraint  Map 

Each  focus  point  within  the  contact  plane  has  a  corresponding  contact  code. 
Examining  each  point  in  the  plane  will  result  in  discrete  regions  of  identical  codes  with 
defined  boundaries  between  adjacent  regions.  Edwards  defines  the  map  which  graphically 
depicts  these  regions  and  boundaries  as  the  Constraint  Map  (3:p2-10j.  For  this  project  the 
region  of  interest  is  the  one  which  satisfies  the  grasp  stability  criteria  in  Section  3.5;  that 
is,  the  "111"  contact  code  region.  Edwards  appropriately  defines  this  particular  region  as 
the  Stable  Area  (3:p3-5J  or  for  use  herein,  the  Stable  Region. 

The  grasp  analysis  equations  imply  that  if  the  contact  locations,  cylinder  radius, 
friction  coefficient,  and  external  moment  are  constant,  the  only  way  to  change  the  contact 
force  solution  is  to  vary  or  the  focus  location  y^).  However,  the  maximum  value 
of  is  bounded  by  the  joint  torque  limits  of  the  hand.  Beyond  this  maximum  value. 


3-9 


Table  3-1.  Contact  Type  Designations  (1] 


adjusting  the  focus  location  is  the  only  remaining  method  to  effect  the  contact  force 
solution. 

For  a  given  constraint  map,  the  only  variable  parameter  is  the  location  of  the  grasp 
focus.  All  of  the  other  grasp  parameters  (r^.  reniain  constant. 

Changing  any  one  of  the  other  parameters  will  result  in  a  different  constraint  map. 
Edwards  demonstrated  however,  that  if  the  ratio  of  to  is  constant  then  the 
constraint  map  will  also  remain  constant.  Edwards  defines  this  ratio  as  |3:p4-81. 
This  a  useful  property  for  comparing  different  constraint  maps,  as  will  become  evident  in 
the  next  chapter. 

3. 7  Determining  Joint  Torques  for  Hand  Model 

Changing  the  location  of  the  grasp  focus  directly  effects  tlie  commanded  contact 
forces  which  the  hand  must  provide.  If  the  hand  grasping  the  cylinder  has  limited  joint 
torquing  capabilities,  then  there  may  be  areas  within  the  stable  region  which  are 
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unacceptable  for  focus  placement.  The  net  region  for  positioning  the  grasp  focus  which 
satisfies  both  stability  and  joint  torque  criteria  is  defined  as  the  Safe  and  Stable  Region 
(3:p4-221. 

The  joint  torques  are  not  only  a  function  of  the  commanded  contact  forces,  but  also 
a  function  of  cylinder  position  and  orientation.  Using  the  kinematic  equations  from 
Chapter  11,  the  final  issue  to  resolve  is  the  relationship  oetween  contact  forces  and  joint 
torques. 

3. 7. 1  Manipulator  Jacobian.  The  endpoint  or  end-effector  forces  are  related  to  the 
joint  torques  by  the  transpose  of  the  manipulator  Jacobian  119;p243]. 

(3.12) 

where  f  is  a  vector  of  the  joint  torques  for  a  given  finger,  and  is  a  vector  of  the 

endpoint  force  components  expressed  in  the  base  joint  frame.  Since  the  hand  model 
assumes  point  contacts  and  each  finger  has  four  joints,  the  Jacobian  (7)  is  a  3  X  4  matrix. 

There  are  two  details  to  consider  before  applying  Equation  3-12  to  the  hand  model. 
First,  the  kinematic  structure  of  Finger  0  is  different  than  that  for  Fingers  1  and  2. 
Therefore,  the  corresponding  Jacobian  matrices  are  different  since  the  /1-matrices  form  the 
basis  fory.  The  Jacobian  matrix  for  each  finger  is  fairly  large  in  size,  and  therefore  are 
listed  in  Appendix  H.  The  second  issue  is  that  the  contact  force  components  (Equation  3- 
11)  are  expressed  in  contact  frame  coordinates.  These  components  must  first  be  translated 
into  finger  base  frame  coordinates  before  using  Equation  312.  The  contact  forces  can  be 
assembled  into  the  following  vectors: 


(x  ) 

(x  ) 

(x 

^co  ~ 

0 

Fa  = 

0 

^C2- 

0 

\  ‘j-J 

^2 

[  ^t) 

(3.13) 


These  forces  can  then  be  translated  to  the  appropriate  finger  base  frame  with  rotation 
matrices. 


CO 


Cl 


-  R^ 


C2 


C2 


(3.14) 


Substituting  Equations  3-13  and  3-14  into  Equation  3-12,  the  joint  torques  on  Finger  j 
(J-Z,\,2)  is  given  by: 


^2; 


(3.15) 


where  Jq,  are  the  Jacobian  matrices  for  Fingers  0.  1,  and  2  respectively  (see 
Appendix  H),  and  the  rotation  matrices  are  given  by; 


-S„C(<p^*iffco) 


S(<Pb*'f'co) 

-C^C((p^*4(co) 


0  -C{<p^*i//co) 


(3.16) 
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Rt  = 


-C(a^+<Pp)C((pj,+\lr^J  -S(a^-^<Pp)  C(ai^->-<pp)  S((f>^->-iff^^) 


(3.17) 


where  k  =  1,2 


3.7.2  Equivalent  Maximum  Joint  Torques.  Each  link  of  a  UMDH  finger  is  actuated 
by  flexor  and  extensor  tendons.  These  tendons  can  be  adjusted  to  obtain  a  desired  co¬ 
contraction  level,  such  that  they  work  against  each  other  to  provide  finger  stiffness.  If  the 
co-contraction  level  is  set  to  zero,  only  the  flexor  tendons  are  in  tension  when  grasping  an 
object.  Using  this  as  an  assumption  maximizes  the  flexional  torque  capabilities  of  each 
finger,  and  simplifies  the  determination  of  equivalent  maximum  joint  torques. 

Using  technical  data  for  the  UMDH  from  (17]  and  |20]  Edwards  goes  into  detail  on 
how  to  determine  the  equivalent  maximum  joint  torques  for  a  given  finger  |3:p2-16  to  2- 
18].  If  the  pulley  radii  at  each  joint  and  the  maximum  flexor  tendon  tension  are  known 
values,  the  equivalent  maximum  torques  for  a  UMDH  finger  are; 

^0  Zq  0  0  0 

T,  _  ®  '’i  '■i 

Tj  0  0  Tj  Tj 

^  0  0  0  Zj 

'  ^  'nuLj. 


To 


(3.18) 


where  Tq,  Tj,  r^,  are  the  pulley  radii  at  joints  zero,  o.ne,  two,  and  three  respectively. 
Equation  3-18  can  be  applied  to  each  of  the  fingers  since  each  of  the  corresponding  joints 
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are  identical.  Therefore,  the  maximum  joint  torques  derived  by  Edwards  can  be  used  in 
this  project.  The  only  difference  is  the  addition  of  the  base  or  zero  Joint.  For  simplicity, 
it  will  be  assumed  that  the  maximum  Joint  torque  for  the  base  Joint  is  the  same  as  that  for 
Joint  one.  This  approximation  is  valid  since  the  flexor  tendon  tensions  for  the  two  Joints 
are  the  same  [20:pl.l3).  The  only  real  assumption  is  that  the  pulley  radii  are  equal. 

Given  this,  the  equivalent  maximum  Joint  torques  for  each  finger  in  the  hand  model  are; 

2.958  Mm  ' 

2.958  Nm 

(3.19) 

1.139  Nm 
0.427  Nm  , 

For  a  panicular  grasp,  the  Joint  torques  are  calculated  using  Equation  3-15  and 
compared  to  the  maximum  Joint  torque  limits  in  Equation  3-19.  If  anyone  of  the 
calculated  joint  torques  exceed  the  specified  limit,  then  one  of  two  grasp  parameters  must 
be  readjusted.  Either  the  grasp  force  magnitude  must  be  reduced  or  the  grasp  focus  must 
be  repositioned  to  an  area  within  the  stable  region  where  the  limits  are  not  exceeded. 
Repositioning  the  grasp  focus  is  reasonably  easy  but  knowing  where  to  reposition  it  to  is 
not  always  intuitively  obvious. 

3. 8  Joint  Torque  Constraint  Maps 

The  joint  torque  constraint  map  is  similar  to  the  constraint  maps  discussed  earlier  in 
this  chapter.  Instead  of  mapping  contact  code  regions,  the  joint  torque  constraint  map 
identifies  two  distinct  regions  within  the  grasp  plane  for  each  finger  Joint;  die  region  where 
the  joint  torque  limit  is  exceeded  for  a  specific  joint,  and  the  region  where  it  is  not.  Since 
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there  are  only  two  regions,  mapping  only  the  boundary  between  the  two  is  all  that  is 
necessary.  Mapping  only  the  boundary  infers  that  one  can  still  identify  which  side  of  the 
boundary  is  the  "good"  side. 

As  mentioned  in  Section  3.7,  the  SAS  region  meets  both  grasp  stability  criteria  and 
joint  torque  criteria.  The  SAS  region  can  be  thought  of  as  a  subset  of  the  parent  stable 
region.  If  no  Joint  torque  limits  are  exceeded  for  a  specified  stable  grasp,  then  the  SAS 
and  Stable  regions  are  the  same.  Stated  another  way,  if  the  joint  torque  boundary  lines 
never  cross  over  the  stable  region,  the  SAS  region  is  the  entire  stable  region.  The  SAS 
region  is  reduced  only  when  the  joint  torque  boundai^  lines  cross  over  the  stable  region. 
When  this  occurs,  the  SAS  region  becomes  a  subset  of  the  stable  region. 

This  finally  brings  us  to  the  main  point  of  this  project.  The  size  of  the  SAS  region 
is  dependent  on  the  imposed  joint  torque  limits.  If  the  grasped  object  is  manipulated,  ihe 
size  of  the  SAS  region  will  change  from  one  object  position  and  orientation  to  the  next 
since  the  joint  torques  for  each  finger  are  changing.  It  is  feasible  that  positioning  the 
grasp  focus  at  one  point  may  be  acceptable  for  only  a  small  portion  of  the  manipulation 
task.  Therefore  it  is  necessary  to  gain  an  understanding  of  how  the  SAS  region  changes  as 
an  object  is  manipulated. 

A  grasp  analysis  computer  program  was  developed  to  generate  the  data  for  mapping 
joint  torque  boundary  lines,  and  stable  and  SAS  regions  for  a  given  grasp  configuration. 
Joint  angle  data  from  the  inverse  kinematics  program  discussed  in  Chapter  II  is  used  as 
input  data  to  establish  the  specific  cylinder  position,  orientation,  and  contact  location.  The 
evolution  of  the  SAS  region  is  examined  as  a  function  of  cylinder  rotation  by  generating 
maps  at  discrete  rotation  increments.  These  "snapshot"  map  sets  are  also  generated  as  a 
function  of  cylinder  proximity  to  the  hand. 
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IV.  Computer  Generation  of  Constraint  Maps 


4. 1  Grasp  Simulation  Setup 

With  the  kinematic  and  grasp  analysis  complete,  we  are  now  able  to  analyze  the 
grasping  and  manipulation  of  the  cylinder.  To  reiterate,  the  project  goal  is  to  develop  a 
planning  procedure  for  grasping  a  cylinder  and  rotating  it  about  its  longitudinal  axis  while 
opposing  an  external  moment.  The  procedure  must  be  able  to  examine  various  grasp 
configurations  by  varying  cylinder  rosiiion  and  orientation.  One  of  the  study  objectives  is 
to  develop  relationships  v/hich  compare  the  stability,  robustness,  and  torquing  capability  of 
the  different  grasp  configurations.  To  do  this  we  must  first  establish  the  simulation 
parameters.  These  parameters  are  divided  into  two  sets;  1)  Kinematic  Parameters  (\pQ, 

4'2>  ''c-  ^4'  ^3’  O'b)’  2nd  2)  Grasp  Parameters  m^,  u)-  It  should  be  noted  that  the 

contact  angles  (\pQ,  iZ-i),  and  cylinder  radius  (r^  are  considered  both  Kinematic  and 
Grasp  parameters. 

4.I.J  Kinematic  Parameters.  The  kinematic  parameters  establish  the  contact 
locations  on  the  cylinder  (iZ-q.  i/',,  iZ-n).  and  the  cylinders’  position  (d^.  a^,)  and 

orientation  with  respect  to  the  hand.  In  determining  the  contact  locations,  one  must 
keep  in  mind  that  the  cylinder  is  going  to  be  rotated  about  its’  transverse  axis.  One 
approach  is  to  select  the  contact  locations  such  that  the  cylinder  rotation  is  symmetric 
about  some  "neutral"  position. 
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4.1.1. 1  Contact  Location.  The  coordinate  frame  origins  for  the  cylinder  are 
all  located  in  the  x-z  plane  of  the  base  joint  on  Finger  0  (reference  Section  2.3).  This  is 
also  the  plane  of  symmetry  for  the  locations  of  the  base  joint  and  joint  one  for  Fingers  1 
and  2  (reference  Section  2.2.2).  Therefore,  the  contact  location  scheme  should  take 
advantage  of  this  plane  of  symmetry. 

The  neutral  position  of  the  cylinder  occurs  when  its'  rotation  angle  equals  zero. 
By  setting  the  contact  angle  -  90“  and  ±  90°  ("  +  "  for  +\p2.  for  -i/';) 

the  contact  locations  will  be  symmetric  about  the  x-z  plane  of  the  base  joint  on  Finger  0 
when  <t>^^  -  0° .  With  this  contact  scheme,  the  maximum  clockwise  rotation  of  the  cylinder 
is  equal  to  the  maximum  counter-clockwise  rotation.  This  is  only  true  if  the  joint  rotation 
limits  and  link  lengths  for  Fingers  1  and  2  are  identical,  which  is  true  for  the  hand  model. 

In  Section  2.3  the  cylinder  radius  r^.  was  set  to  1.0812  inches.  This  panicular  radius 
value  was  selected  with  the  semi-symmetric  contact  configuration  set  in  mind.  With  the 
cylinder  in  the  neutral  position  (0i,=O°)  and  the  contact  angles  set  to  {i/'q  =  90°,  i/-,  =  - 
50°,  i/'2  =  -130°},  each  of  the  fingers  are  parallel  to  the  x-z  plane  of  the  palm  frame;  i.e., 
their  respective  base  joints  are  also  in  a  neutral  position  0o''=9O°}. 

This  implies  a  maximum  cylinder  rotation  angle  without  violating  joint  rotation  limits. 

The  computer  simulation  examines  iwo  different  configurations  of  contact  locations. 
Tlie  first  will  oe  with  the  contact  angles  set  to  {\^q  =  90°,  -•  -50°,  'I-,  =  -130°}.  This 

contact  configuration  will  be  termed  .scmi-.sytnmetric,  since  .wo  of  the  three  angles 
separating  the  contacts  are  equal  (140°,  140°,  80°;.  The  second  contact  configuration  is 
set  to  {tfo  =  90°.  i/|  =  -30°.  i2  ~  This  contact  configuration  will  be  termed 

symmetric,  since  all  three  angles  separating  the  contacts  are  equal  (120°,  120°,  120°). 
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4. 1.1. 2  Grasp  Configuration.  The  parameters  d^,  dj,  and  establish  how 
the  hand  "holds"  the  cylinder.  In  Section  2.5  the  desired  cylinder  tilt  angle,  was 
calculated  as  -24.0777°.  At  this  angle,  the  range  of  d^  and  dj  is  maximized.  The  cylinder 
proximity  parameter  (d^)  determines  how  close  or  far  away  the  cylinder  is  from  the  palm 
frame  origin.  The  cylinder  bias  parameter  determines  whether  the  cylinder  is  bias  towards 
Finger  0  (thumb-bias)  or  towards  Fingers  I  and  2  (finger-bias). 

For  the  simulation  a  retracted  grasp  configuration  refers  to  a  minimal  value  for  d^, 
and  an  extended  grasp  configuration  refers  to  a  maximal  value  for  d^.  An  intermediate 
grasp  configuration  refers  to  a  mid-range  value  for  d^.  There  are  three  "types"  of  values 
for  d^  for  each  value  of  d^.  thumb-bias,  neutral  (equal  fingertip  angles)  and  finger-bias. 
Figures  4-1  through  4-4  show  examples  of  the  different  types  of  grasp  configurations  for 
the  simulation.  Note  that  different  grasp  configuration  combinations  can  be  examined  (i.e. 
thumb-bias  neutral  grasp,  finger-bias  neutral  grasp,  etc.) 

4. 1.1.3  Artificial  Constraints.  As  discussed  in  Section  2.5,  the  range  of  the 
cylinder  bias  parameter  (dfi  and  the  cylinder  proximity  parameter  (d^)  is  bounded.  The 
maximum  value  of  d^  is  limited  by  finger  lengths  and  its’  minimum  value  is  limited  by 
fmgenip  grasp  angles.  For  this  study,  the  grasp  angles  must  be  positive  so  that  the  contact 
location  resides  on  the  bottom-side  of  the  fingertip. 

The  range  of  ^(3  is  bounded  by  either  joint  angle  limits  (reference  Table  2-4)  or  by 
the  constraint  of  positive  grasp  angles.  In  a  retracted  grasp  configuration  (minimum  value 
of  d^),  the  range  of  dj  is  limited  by  grasp  angles  As  the  value  of  t/4  incieases,  the  range 
of  d^  may  be  bounded  by  either  joint  angle  limits  or  by  the  positive  grasp  angle  constraint. 
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Figure  4-2.  Extended  Neutral-Bias  Grasp  Configuration 


Figure  4-3.  Intermediate  Thumb-Bias  Grasp  Configuration 


Figure  4-4,  Intermediate  Finger-Bias  Grasp  Coiu'iguration 
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An  artificial  constraint  is  imposed  on  the  cylinder  rotation  angle  to  avoid  positioning 
the  contact  on  the  "fingernail''  portion  of  the  fingertip  (positive  grasp  angle).  For  the  first 
contact  configuration,  is  limited  to  ±50°;  for  the  second.  <l>^  is  limited  to  ±30°. 

Table  4-1  provides  a  summary  of  the  corresponding  values  for  ypQ,  i/'j, 
d^,  d^,  and  a^.  Select  combinations  of  the  kinematic  parameters  will  be  utilized  as  input 
to  the  inverse  kinematics  program. 

4.]. 2  Grasp  Parameters.  The  grasp  parameters  establish  how  "hard"  the  cylinder  is 
grasped  (grasp  force  magnitude),  the  magnitude  and  direction  of  the  applied  torque,  and 
the  static  friction  coefficient  for  each  contact  location.  As  mentioned  earlier,  if  (ratio 
of  m^r^  to  A/g,)  is  constant  then  tne  constraint  map  will  also  remain  constant.  This  in-turn 
means  that  the  size  and  shape  of  the  stable  region  will  remain  constant.  Mathematically 
c^ap  is  improper  since  a  zero  value  for  Mq.,  makes  go  to  infinity.  With  r^  as  a 
constant,  the  variable  ratio  will  be  redefined  as: 

^  — ~  tn  >  0  (4.1) 

Equation  4.1  is  a  useful  property  for  comparing  different  constraint  maps.  For  this 
project,  one  of  the  task  objectives  is  to  apply  the  greatest  amount  of  torque  over  a 
specified  cylinder  rotation  range.  All  the  kinematic  and  grasp  parameters  are 
predetermined,  except  and  Assume  that  the  grasp  focus  positioning  accuracy  for 
the  hand  is  known.  That  is,  given  the  limitations  of  the  hand  controller,  sensors,  etc.,  the 
grasp  focus  can  be  positioned  at  a  specific  point  within  the  grasp  plane  {aTj,.  y^,;  ±XX 
mm}. 
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Table  4-1.  Kinematic  Parameters 


Input 

Nominal  Value 

Input 

Nominal  Value 

«b 

-24.0777° 

''c 

1.0812  in,  (27.5  mm) 

^3 

0.52  in.  (13.2  mm) 
Thumb-bias 

d. 

3.01969  in.  (76.7  mm) 
Retracted 

1.16335  in.  (29.5  mm) 
Neutral-Bias 

3.46  in.  (87.9  mm) 
Intermediate 

1 .8067  in.  (45.9  mm) 
Finger-Bias 

3.9055  in.  (99.2  mm) 
Extended 

^0-  '/'!•  '/'2 

{90°. -50°, -130°} 

<^>b 

Variable 

Maximum  ±50° 

{90°. -30°. -150°) 

Variable 

Maximum  ±30° 

The  focus  positioning  error  (±XX  mm)  corresponds  to  the  desired  region  for  grasp 
focus  positioning.  Therefore,  can  be  adjusted  (by  varying  and  separately) 
until  the  resulting  stable  region  encompasses  an  area  equivalent  to  the  size  of  the  error 
region.  This  is  a  coarse  setting  for  c„,ap  since  the  desired  error  region  may  be  partially  or 
totally  eliminated  by  torque  limit  lines  as  the  cylinder  is  rotated.  The  preferred  goal  is  to 
enclose  the  error  region  within  the  net  SAS  region  (See  Figure  4-5).  The  net  SAS  region 
is  the  intersection  of  all  the  SAS  regions  sampled  at  discrete  rotation  increments. 

The  coarse  setting  of  c,„ap  serves  a  purpose,  it  "freezes"  the  size  of  the  Stable 
region.  Since  the  SAS  region  is  a  subset  of  the  stable  region,  further  adjustments  are 
made  by  only  changing  the  Reducing  the  ratio  will  increase  the  size  of  the  net 

SAS  region,  because  of  the  joint  torque  reduction  due  to  a  smaller  value  for  m^. 
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Figure  4-5.  Locating  the  Error  Region  within  the  Net  SAS  Region 


However,  reducing  the  ratio  also  corresponds  to  a  reduction  in  applied  torque.  When 
the  solution  is  close  at  hand,  line  adjustments  are  made  to  by  increasing  or  decreasing 

Wbz  only- 

Once  the  final  value  of  c;„,,p  is  established,  the  same  ratio  is  used  for  different  grasp 
configurations  (i.e.  extended  finger-bias,  etc).  The  different  grasp  configurations  are 
compared  to  determine  which  configuration  provides  the  maximum  torquing  capability 
over  a  specified  cylinder  rotation  range. 


4.2  Computer  Programs 

The  inverse  kinematics  and  grasp  analysis  programs  are  used  in  combination  to 
generate  the  necessary  data  for  a  single  constraint  map.  Each  constraint  map  represents  a 
specific  grasp  configuration  and  cylinder  rotation  angle.  For  example,  one  map  may 
represent  a  retracted  neutral-bias  grasp  of  the  cylinder,  with  the  cylinder  oriented  at  a 
rotation  angle  equal  to  -15°.  Generating  several  of  these  maps  at  different  cylinder 
rotation  angles,  comprises  a  constraint  map  set  for  a  specific  grasp  configuration. 

A  map  set  can  be  thought  of  as  representing  a  "quasi-static"  .otation  of  the  cylinder. 
Granted  this  approach  to  simulating  cylinder  rotation  ignores  dynamic  effects,  but  it  does 
allow  the  examination  of  how  the  SAS  region  changes  as  the  cylinder  is  rotated.  If  one 
assumes  that  the  inertial  properties  of  the  fingers  and  the  cylinder  are  small  in  magnitude 
and/or  the  rotational  movement  is  slow,  the  approach  is  valid. 

By  specifying  4>^^  as  an  input  parameter,  the  inverse  kinematics  program  will 
calculate  and  output  the  corresponding  finger  joint  angles  and  specified  kinematic 
parameters  to  an  external  data  file  called  "Hand.dat '.  The  grasp  analysis  program  will  the 
use  this  data  file  as  input.  The  grasp  analysis  program  will  prompt  the  user  for  five 
primary  inputs.  The  first  two  are  A/g^  and  The  third  input  is  the  value  for  the  static 
friction  coefficient  p. 

The  remaining  two  inputs  relate  to  sampling  points  for  locating  the  grasp  focus. 

One  of  these  inputs  requests  the  user  to  specify  the  map  scale.  The  map  scale  is  the 
number  of  cylinder  radii  from  the  center  of  the  map  to  its  edge;  where  map  center 
corresponds  to  the  cylinder  center  This  results  in  a  square  map  over  which  to  sample  for 
grasp  focus  locations.  The  last  parameter  is  the  resolution  of  the  map,  where  the 
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resolution  is  measured  from  the  map  center  in  the  j:  and  y  directions.  The  map  resolution 
parameters  divide  the  map  into  a  N  by  M  equally  spaced  grid. 

The  grasp  program  samples  each  grid  point  to  determine  if  it  is  an  acceptable 
location  for  the  grasp  focus.  To  become  an  acceptable  focus  location,  the  particular 
sample  point  must  satisfy  stability  and  joint  torque  limit  criteria.  The  combination  of  all 
acceptable  points  form  the  SAS  region.  The  program  also  generates  the  data  for  mapping 
the  joint  torque  and  stable  region  boundary  lines.  A  plot  of  the  resulting  data  is  then  made 
using  commercially  available  software.  This  plot  is  superimposed  over  an  image  of  the 
cylinder  cross-section  and  contact  locations  for  visual  reference  (similar  to  Figure  4-5). 
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V.  Results  and  Discussion 


5. 1  Over  view 

5.1.1  Desirable  Grasp  Characterises.  With  the  analysis  complete,  we  can  now 
use  the  computer  programs  to  examine  various  grasp  configurations  by  varying  cylinder 
position  and  orientation.  From  this,  general  relationships  can  be  developed  which  compare 
the  stability,  robustness,  and  torquing  capability  of  the  different  grasp  configurations. 

There  are  three  desirable  grasp  characteristics  for  the  cylinder  manipulation  task. 

The  first  is  that  the  grasp  must  satisfy  stability  and  joint  torque  criteria  over  a  specified 
cylinder  rotation  range  (50°  to  100°  for  this  study).  This  is  the  basic  requirement;  if  not 
satisfied,  the  task  cannot  be  successfully  completed.  The  second  requirement  is  that  the 
grasp  must  satisfy  robustness  criteria.  The  third  requirement  is  that  the  grasp  must 
provide  the  greatest  torquing  capability  to  oppose  external  moments.  Both  of  these  last 
hA'o  requirements  are  considered  user  specified  requirements,  and  are  therefore  optional. 

If  desired,  the  two  requirements  must  be  satisfied  over  the  specified  cylinder  rotation 
range.  For  this  study  it  is  assumed  that  all  three  requirements  are  imposed. 

Each  of  the  desirable  grasp  characteristics  are  directly  related  to  the  net  SAS  region. 
All  points  within  the  net  SAS  region  satisfy  stability  and  joint  torque  criteria.  As 
mentioned  in  the  introduction,  Edwards  demonstrated  that  for  an  enveloping  three-point 
grasp  (which  is  the  case  herein)  the  cylinder  center  point  is  the  optimum  location  for 
applying  the  maximum  amount  of  torque  |3:p4-131  (this  statement  will  be  proven  in 
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Section  5.6).  Therefore,  from  a  cylinder  torque  perspective,  the  best  point  for  locating  the 
grasp  focus  is  at  the  center  of  the  cylinder. 

To  satisfy  robustness  criteria,  the  net  SAS  region  must  enclose  the  error  region 
(reference  Section  4. 1 .2).  From  a  robustness  perspective,  the  geometric  center  of  the  net 
SAS  region  is  the  optimum  location  for  the  grasp  focus.  From  this  point,  the  focus  can 
achieve  the  largest  planar  deviation  from  its’  nominal  position. 

If  the  net  SAS  region  is  larger  than  the  error  region,  this  implies  that  the  grasp  has 
the  potential  to  apply  more  torque  to  the  cylinder.  This  is  due  to  the  fact  that  the  size  of 
the  net  region  is  directly  related  to  the  external  moment  magnitude;  as  the  external 
moment  magnitude  is  increased,  the  size  of  the  net  SAS  region  decreases. 

5.1.2  Ideal  Grip.  Combining  all  this  information,  the  conditions  for  an  "ideal"  grip 
can  be  assembled.  For  an  ideal  grip,  the  net  SAS  region  is  equal  in  size  and  shape  to  that 
for  the  error  region.  With  this  condition,  the  two  regions  can  be  centered  directly  over  the 
center  of  the  cylinder  to  achieve  the  maximum  combination  of  grasp  torquing  capability 
and  robustness.  As  will  be  demonstrated  in  ihe  ensuing  sections,  the  ideal  grip  cannot  be 
achieved  with  the  hand  model  employed.  However,  with  proper  planning  an  acceptable 
grasp  configuration  can  always  be  achieved. 

5.1.3  Cotrparin^  Grips.  The  issue  to  address  first  is  how  the  SAS  region  evolves 
as  the  cylinder  is  rotated.  This  v.ill  provide  the  basic  understanding  of  which  joint  or 
joints  on  each  finger  effect  the  size  and  shape  of  the  SAS  region.  The  effects  of  grasp 
configuration  on  the  net  SAS  region  is  then  examined  by  developing  constraint  m.aps  for 
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each  of  the  different  grasp  combinations  (reference  Section  4. 1,1. 2).  An  equal  comparison 
can  be  made  by  setting  the  external  moment  and  grasp  force  magnitude  to  a  constant  value. 
Given  this,  the  net  SAS  region  becomes  a  function  of:  a)  cylinder  orientation  (cylinder 
rotation  angle),  b)  cylinder  position  (cylinder  bias  and  proximity),  and  c)  contact  location. 

The  results  examine  the  effects  of  cylinder  proximity,  cylinder  bias,  and  contact 
location  on  the  size  and  shape  of  the  net  SAS  region  for  the  following  cases: 

Case  I.  Varying  Cylinder  Proximity 

-  Retracted  Grasp 

-  Intermediate  Grasp 

-  Extended  Grasp 

Case  2.  Varying  Cylinder  Bias 

-  Thumb-Bias 

-  Neutral  Bias 

-  Finger-Bias 

Case  3.  Cliangir.g  Contact  Locations 

-  Semi-Symmetric  Contacts 

-  Symmetric  Contacts 

The  goal  is  to  develop  relationships  which  compare  the  stability,  robustness,  and 
torquing  capability  of  the  different  grasp  configurations.  With  these  relationships  we  can 
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determine  which  grasp  configuration  corresponds  to  the  highest  torquing  capability  over  a 
specified  cylinder  rotation  range.  This  will  be  demonstrated  by  combining  the 
relationships  to  design  a  robust  grasp  for  high  torque  applications. 

Finally,  the  net  SAS  region  is  examined  in  detail  to  determine  stability  behavior 
within  the  neighborhood  of  grasp  focus  point.  The  objective  is  three-fold.  The  first  is  to 
gain  some  insight  as  to  the  advantages  and  disadvantages  of  locating  the  grasp  focus  at 
different  points  within  the  net  SAS  region.  The  second  is  to  prove  that  the  cylinder  center 
point  is  the  optimal  focus  location  for  increased  torquing  capability.  The  third  is  to 
discuss  what  determines  the  shape  of  the  stable  region. 

The  grasp  planning  procedure  presented  herein  is  a  generalized  approach  for  grasp 
design.  It  is  not  intended  to  represent  an  optimization  scheme;  although  the  different 
constraint  maps  can  be  compared  to  determine  relative  "maximum"  graphical  solutions. 

5.2  Effects  of  Cylinder  Rotation  on  SAS  Region 

The  grasp  initial  configuration  will  consist  of  an  intermediate  neutral  grasp  (refer  to 
Table  4-1)  using  a  semi-symmetric  contact  location  layout  {\I^q  =  90°,  i/-,  =  -50°,  =  ' 

130°}.  This  configuration  combination  will  also  serve  as  the  baseline  configuration  for 
later  comparisons  to  different  grasp  types.  Metric  unit:  will  be  used  for  convenience  since 
generating  specific  types  of  constraint  maps  can  require  small  parameter  changes. 

The  external  moment  (Mq,)  is  set  to  0.6  N-m  (counter-clockwise)  and  the  internal 
grasp  force  magnitude  is  set  to  67  N.  Using  Equation  4-1.  this  corresponds  to  a 
value  of  0.3261  (where  27.46  mm).  The  starting  value  for  the  cylinder  rotation  angle 
(0i,  or  "Phi  Body")  is  50  degrees.  This  angle  represents  the  maximum  counter-clockwise 
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rotation  angle.  The  resulting  constraint  map  is  shown  in  Figure  5-1,  which  includes  the 
joint  angles  for  each  of  the  three  fingers.  The  Joint  angle  term,  T^j,  at  the  bottom  of  the 
figure  denotes  Joint  angle  6  at  Joint  i  on  finger  j  (where  /=0,1,2,3  and  7=0, 1,2). 

The  circle  represents  the  cylinder  cross-section  within  the  contact  plane.  The  terms 
CO,  Cl,  and  C2  denote  the  contact  locations  for  Fingers  0,  1,  and  2  respectively.  The 
shaded  area  within  the  circle  represents  the  SAS  region.  The  curve  surrounding  the  SAS 
region  denotes  the  stable  region  boundary.  The  SAS  region  and  the  stable  region  are 
synonymous  for  this  rotation  increment;  i.e.,  the  Joint  torque  limits  have  no  effect  on  the 
SAS  region.  Note  that  the  geometric  center  of  the  SAS  region  is  bias  towards  the  first 
contact  point,  even  though  the  contact  locations  are  symmetric  about  the  horizontal  center 
axis.  'I'his  phenomena  will  be  examined  further  in  Section  5-6. 

Clockwise  rotation  samples  are  then  taken  at  seven  sue  essive  values  for  {30°, 
15°,  0°,  -15°,  -30°,  -40°,  -50°}.  The  maximum  clockwise  cylinder  rotation  occurs  when 
0(,  =  -50  degrees;  therefore  the  total  poieniial  rotation  angle  for  this  grasp  and  contact 
configuration  is  100  degrees.  Potential  is  stressed  since  the  actual  total  rotation  angle  can 
be  less  than  100  degrees  if  the  SAS  region  is  eliminated  prior  to  the  end  of  rotation.  The 
constraint  maps  for  each  of  the  rotation  samples  are  shown  in  Figures  5-2  through  5-8. 

The  new  term,  JiJ,  represents  a  specific  joint  torque  limit  line  due  to  a  Joint  torque 
violation  at  joint  i  on  finger  j  (where  /=0,1,2.3  and  7=0, 1,2). 

Comparing  the  series  of  figures,  it  is  evident  that  joint  torque  limits  progressively 
reduce  the  size  of  the  SAS  region  as  the  cylinder  is  rotated  in  a  clockwise  direction.  Keep 
in  mind  that  this  is  true  for  a  counter-clockw  ise  external  moment.  Although  not 
demonstrated,  the  opposite  is  true  for  an  opposing  clockwise  external  moment;  that  is.  the 
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Figure  5-1.  Intermediate  Neutral-Bias  Grasp,  ~  50 
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Figure  5-2.  Intermediate  Neutral-Bias  Grasp.  =  30' 
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Figure  5-3.  Intermediate  Neutral-Bias  Grasp.  (i>^,  = 
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Figure  5-7.  IntermeJiate  Neutral-Bias  Grasp,  0^,  =  -40° 


Figure  5-8.  Intermediate  Neutral-Bias  Grasp,  0^,  =  -50° 
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Figure  5-9.  Net  SAS  Region  for  Intermediate  Neutral-Bias  Grasp 


joint  torque  limits  progressively  reduce  the  size  of  the  SAS  region  as  the  cylinder  is  rotated 
in  a  counter-clockwise  direction.  Note  that  the  cylinder  center  is  no  longer  a  valid  point 
for  locating  the  grasp  focus  after  the  first  half  of  rotation.  The  net  SAS  region 
(intersection  of  all  SAS  regions)  is  shown  in  Figure  5-9. 

After  the  cy'inder  is  rotated  past  =  30®,  the  size  and  shape  of  the  SAS  region  is 
primarily  determined  by  J20  This  is  not  surprising  since  Finger  0  opposes  Fingers  1  and 
2.  A  valid  question  i.s,  why  joint  two  and  not  joint  one’’  Referring  back  to  Figure  4-3,  the 
moment  arm  for  joint  two  is  approximately  half  f'  at  for  joint  one.  However,  the  joint 
torque  limu  for  joint  two  (2.958  N-m)  is  less  than  40%  of  the  limit  for  joint  one  (1.139  N- 
m).  Therefore,  in  general  JIO  may  or  may  not  cross  over  into  the  stable  region;  in  either 
case  it  always  "follow-,  j20  and  df  cs  not  effect  the  SAS  region  This  in  fact  dees  occur. 


5-10 


but  the  line  is  not  depicted  in  the  figures  for  clarity.  This  is  a  hand  design  dependent 
phenomena.  If  different  hand  dimension  or  joint  torque  limits  are  used,  then  different 
results  can  be  expected. 

The  Joint  torque  limit  for  Joint  zero  is  the  same  as  that  for  Joint  one,  and  its  moment 
arm  is  slightly  longer  than  that  for  Joint  one.  Like  JW,  the  figures  indicate  that  the  limit 
lines  for  Joint  zero  also  lag  behind  and  do  not  effect  the  SAS  r  ^gion. 

At  the  final  phase  of  rotation  (-30°  to  -50°),  J21  approaches  and  eventually  violates 
the  top  portion  of  the  SAS  region.  Although  not  shown  for  clarity  reasons,  the  limit  line 
for  Joint  two  on  Finger  2  also  crosses  into  the  stable  region  in  the  same  manner. 

However,  it  lags  behind  the  limit  line  for  Joint  two  on  Finger  1.  A  more  appropriate 
example  of  this  type  of  behavior  will  presented  in  Section  5.3.2. 

The  last  item  to  point  out  is  the  general  movement  of  J20.  At  the  beginning  phase 
of  rotation,  the  line  forms  at  the  lower  left  portion  of  the  stable  region.  As  the  cylinder 
rotation  progresses,  the  line  rotates  about  the  bottom  mid-point  area  of  the  stable  region 
and  "sweeps"  across  towards  contacts  one  and  two.  This  sweeping  motion  is  very 
pronounced  between  0^,=  15°  and  <i)^=  -15°.  During  the  final  phase  of  rotation,  the 
sweeping  movement  of  the  line  slows  and  the  rotation  point  slides  back  towards  the  center 
area  along  the  bottom  edge  of  the  Stable  region. 

5.3  Effects  of  Gru.sp  Configuration  on  S/l5  region 

The  evolution  of  the  SAS  region  is  now  examined  for  different  grasp  configurations 
using  the  same  c^ap  ^alue  and  contact  configuration  as  before.  The  resulting  net  SAS 
region  is  then  compared  to  the  net  SAS  region  for  the  baseline  configuration  (intermediate 
neutral-bias  grasp) 
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5.3.1  Retracted  Neutral-Bias  Grasp.  TTie  cylinder  rotation  is  sampled  at  three 
discrete  rotation  angles  {50°,  0°,  -50}°.  Figures  A-1  through  A-3  (see  Appendix  A)  show 
the  constraint  map  for  each  value  of  Only  three  rotation  increments  are  necessary 
since  the  SAS  region  does  not  change  until  <t>^^  equals  -50  degrees.  This  is  a  significant 
improvement  over  the  intermediate  grasp  since  the  net  SAS  region  is  approximately  the 
same  as  the  stable  region.  This  is  in  effect  due  to  the  short  moment  arm  for  each  finger 
joint.  Note  that  the  first  Joint  torque  limit  line  to  enter  the  stable  region  is  J20.  The  net 
SAS  region  is  identical  to  the  SAS  region  in  Figure  A-3. 

5.3.2  Extended  Neutral-Bias  Gra.^p.  The  cylinder  rotation  is  sampled  at  six  discrete 
rotation  angles  |50°,  30°.  15°,  0°,  -15°.  -20°}.  Figures  B-1  through  B-6  (reference 
Appendix  B)  show  the  resulting  constraint  map  for  each  value  of  4)^^.  After  4>^  =  -15°  the 
SAS  region  fails  to  exist;  therefore,  the  net  SAS  region  does  not  exist,  assuming  a  full 
rotation  is  desired.  At  best  a  partial  cylinder  rotation  form  50°  to  -15°  is  possible  if  the 
grasp  focus  c  :n  be  located  in  a  small  region  just  below  the  far  left  hand  side  of  the  stable 
region.  In  th;  case  the  net  SAS  region  would  be  approximately  equal  to  the  intersection 
of  the  SA'  -gions  shown  in  Figure  B-2  and  Figure  B-5.  This  grasp  configuration  is 
,:,c.  powered  by  the  combination  of  commanded  grasp  force  magnitude  and  external 
moment;  that  is.  the  resulting  contact  forces  are  beyond  the  joint  torquing  capability  of  the 
hand  during  the  final  phase  of  cylinder  rotation.  This  in  effect  reduces  the  total  cylinder 
rotation  angle  by  35  degrees. 

For  this  grasp  configuration,  there  are  more  joint  torque  limit  lines  which  influence 
the  SAS  region  since  the  joint  moment  arms  are  at  a  maximum.  Again  it  is  apparent  that 
in  the  end,  the  net  SAS  region  is  primarily  determined  by  J20.  Note  that  the  cylinder 
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center  point  is  eliminated  for  grasp  focus  location  after  <i>b=30‘’  (one-third  of  the  cylinder 
rotation). 

As  mentioned  in  Section  5.2,  joint  torque  limit  lines  may  enter  the  stable  region,  but 
have  no  effect  on  the  SAS  region.  In  general  these  "lagging"  lines  are  not  shown  in  the 
figures  for  clarity  reasons.  The  only  limit  lines  shown  are  the  ones  which  do  effect  the 
SAS  region  at  some  point  during  the  cylinder  rotation.  For  demonstration  purposes.  Figure 
B-5  retains  all  Joint  torque  limit  lines  entering  the  stable  region. 

5.3.3  Intermediate  Thumb-Bias  Grasp.  The  cylinder  rotation  is  sampled  at  eight 
discrete  rotation  angles  {50°,  30°,  15°,  0°,  -15°,  -30°,  -40°,  -50°}.  Figures  C-1 
through  C-8  (reference  Appendix  C)  show  the  resulting  constraint  map  for  each  value  of 
<ti^y  During  the  first  part  of  rotation  (50°  to  30°),  the  SAS  regions  are  slightly  larger  than 
corresponding  regions  for  the  baseline  grasp  (intermediate  neutral-bias  grasp).  However, 
the  SAS  region  degrades  rapidly  compared  to  the  baseline  grasp  of  Figure  5-8  as  the 
rotation  progresses  to  the  final  orientation  angle.  This  results  in  a  smaller  net  SAS  region. 
The  net  SAS  region  is  equivalent  to  the  SAS  region  shown  in  Figure  C-6. 

5.3.4  Intermediate  Finder-Bias  Grasp.  The  cylinder  rotation  is  sampled  at  six 
discrete  rotation  angles  {50°,  30°,  15°,  0°,  -15°,  -30°.  -40°,  -50°}.  Figures  D-1 
through  D-8  (reference  Appendix  D)  show  the  resulting  constraint  map  for  each  value  of 
0(,.  The  first  half  of  rotation  is  a  significant  improvement  over  the  baseline  configuration. 
After  a  50°  rotation  the  cylinder  center  point  is  still  well  within  the  SAS  region.  In  fact, 
the  center  point  is  a  valid  focus  point  until  the  rotation  angle  approaches  -30  degrees. 
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Note  that  J20  is  again  the  primary  influence  for  the  SAS  region;  although  J21  and 
J22  also  effect  the  SAS  region.  The  net  SAS  region  (Figure  D-9  )  is  also  an  improvement 
over  the  baselirie  since  it  is  more  equally  proportioned  in  the  vertical  and  horizontal 
directions. 

5.3.5  Intennediaie  Finger-Bias  (Maximum)  Grasp.  Since  a  finger-bias  grasp  is  a 
slight  improvement  over  a  neutral-bias  grasp,  a  fair  question  is,  will  a  further  finger-bias 
grasp  correspond  to  a  larger  net  SAS  region?  To  examine  this  question,  is  set  to  its 
maximum  (62.2  mm).  The  cylinder  rotation  is  sampled  at  same  eight  rotation  angles  as 
before  in  Section  5.3.4.  The  resulting  SAS  regions  are  shown  in  Figures  E-1  through  E-8. 

Compared  to  the  "standard"  intei mediate  finger-bias  grasp,  the  first  half  of  rotation 
results  in  similar  SAS  regions.  However,  the  SAS  region  reduces  in  size  at  a 
comparatively  faster  rate  in  the  second  half  of  rotation.  Note  that  in  the  second  half  of 
rotation  J20  and  J21  both  have  a  significant  effect  on  the  SAS  region.  At  the  end  of 
rotation,  the  SAS  region  is  reduced  to  a  small  group  of  points. 

If  the  grasp  focus  can  be  positioned  at  a  single  point  witliin  the  net  SAS  region,  the 
c,„gp  value  (0.3261)  is  very  close  to  the  optimum  setting  for  this  grasp  and  rotation  range. 
This  assumes  that  the  opiimum  setting  is  one  in  which  the  net  SAS  region  is  as  small  as 
possible.  How'ever,  this  is  more  of  an  "idealization"  since  a  small  net  SAS  region  leaves 
little  room  for  focus  positioning  error. 

5.3.6  Ach’unuiges  and  Disadvantages  of  Finger-Bias  Grasps.  From  these  last  tw'o 
finger-bias  grasps,  it  is  apparent  that  biasing  the  cylinder  towards  Fingers  1  and  2  can 
increase  the  size  of  the  SAS  region  This  is  especially  true  during  the  first  half  of 


rotation.  There  is  point  however,  where  the  advantage  is  lost.  Past  this  point  the  net  SAS 
region  degrades  rapidly,  as  was  demonstrated  by  the  maximjm  finger  bias  grasp. 

From  the  constraint  maps,  one  can  deduce  that  a  properly  positioned  finger-bias 
grasp  (assuming  a  constant  value  for  cl^)  reduces  the  torque  at  joint  two  on  Finger  0.  This 
is  important  since  this  particular  Joint  has  the  greatest  influence  on  the  size  of  the  SAS 
region.  For  the  grasp  parameters  used,  the  best  for  the  finger-bias  grasp  is  the  one  at 
which  the  torque  at  Joint  two  on  Finger  0  is  minimized. 

The  easiest  way  to  determine  this  position  is  through  the  use  of  the  computer  model. 
Using  the  computer  model  is  the  preferred  method  since  the  optimum  cylinder  bias 
parameter  (d^)  is  dependent  on  the  remaining  kinematic  parameters  (specifically  and 
rotation  range}.  For  an  intermediate  grasp,  the  optimum  finger-bias  position  is  the 
"standard"  finger-bias  position  presented  in  Section  5.3.3. 

5.4  Increasing  Torquing  Capability 

From  the  preceding  graphical  analysis,  it  was  discovered  that  a  retracted  grasp 
configuration  corresponds  to  a  large  net  SAS  region.  In  addition  it  is  apparent  that  for  the 
baseline  contact  configuration  {\pQ  =  90°,  =  -50°,  =  -130°},  the  net  SAS  region 

can  be  maximized  by  biasing  the  cylinder  towards  Fingers  1  and  2.  This  information  will 
be  combined  and  used  to  design  a  robust  grasp  for  high  torque  applications. 

5.4.1  Single  Point  Gra.sp  Focus.  Assume  an  ideal  situation  where  the  grasp  focus 
can  positioned  at  a  single  point;  therefore  the  net  SAS  region  corresponding  to  the  greatest 
torquing  capability  for  the  specific  grasp  would  be  as  small  as  possible.  Combining  the 
above  relationihips,  we  w  ill  examine  the  ideal  case  using  a  retracted  finger-bias  grasp  with 
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semi-symmetric  contact  locations.  For  a  coarse  setting  the  stable  region  is  reduced  by 
increasing  until  the  stable  region  encompasses  an  area  about  the  size  of  the  cylinder 
center  cross-hair  in  the  previous  maps.  This  corresponds  to  a  new  value  of  0.4891 
(A/g^  =  .9  Nm,  wij,  =  67  N,  27.46  mm).  The  stable  region  can  be  reduced  further,  but 
we  want  to  be  able  to  visually  examine  the  evolution  of  the  SAS  region.  Holding  and 
constant  so  that  the  size  of  the  stable  region  remains  constant,  Wg,  and  are  increased 
proportionally  until  the  desired  r.^t  SAS  region  is  obtained. 

The  final  values  for  and  tn^  are  1.07  Nm  and  79.65,  respectively.  The  constraint 
maps  for  d)^  -  50°,  -20°,  -30°  and  -50°  are  shown  in  Figures  5-10  through  5-13.  The 
maps  prior  to  d>(,  =  -20°  were  omitted  since  the  SAS  does  not  change  until  after  this  point. 

At  the  end  of  rotation  {<t)^  -  -  50°)  the  SAS  region  is  reduced  to  a  few  pixel  points. 
This  corresponds  to  the  desired  net  SAS  region.  Given  the  focus  assumption  and  contact 
locations,  the  selected  value  of  c,j,^p  provides  the  maximum  torquing  capability  for  a 
retracted  finger-bias  grasp  over  a  100°  cylinder  rotation  range. 

5.4.2  Desi'finiiif;  u  Robust  Grasp  for  High  Torque  Applications.  Using  the  same 
grasp  and  contact  configuration,  assume  that  only  a  50°  cylinder  rotation  range  is  required. 
In  addition,  assume  that  the  desired  focus  position  is  the  cylinder  center,  plus  or  minus  one 
millimeter  (approximately  one-quarter  of  the  cross-hair  area).  Using  Equation  5-1  and  the 
same  vaiue,  Mq,  and  are  increased  proportionally  until  the  desired  net  SAS  region 


Figure  5-10.  Retracted  Finger-Bias,  0^,  =  50“;  Max.  Torque,  100°  Rotation 


Figure  5-11.  Retracted  Finger-Bias,  0j,  =  -2O°;  Max.  Torque,  100°  Rotation 


Figure  5-12.  Retracted  Finger-Bias.  =  Max.  Torque,  100®  Rotation 


Figure  5-13.  Retracted  Finger-Bias,  0j,  =  -5O°;  Max.  Torque,  100°  Rotation 


is  obtained.  This  results  in  =  1.2  Nm  and  =  89.33  N.  Note  that  decreasing  the 
rotation  range  by  one-half,  only  increases  that  torquing  capability  by  approximately  12 
percent. 

The  constraint  maps  for  <t>^j  =  50°,  30°,  20,  5°  and  0°  are  shown  in  Figures  5-14 
through  5-18.  Figure  5-19  shows  the  resulting  net  SAS  region.  Examining  the  net  SAS 
region,  it  is  bounded  on  the  left  and  along  the  bottom  edge  by  torque  limit  lines.  The 
distance  from  these  two  boundaries  to  the  cylinder  center  is  approximately  one  millimeter, 
as  required,  However,  there  is  a  larger  usable  area  to  the  upper-left  of  the  center  point, 
From  a  robustness  perspective,  the  best  location  for  the  grasp  focus  is  in  the  geometric 
center  of  the  SAS  regioi  From  this  point,  larger  focus  positioning  errors  can  be  absorbed 
by  the  grasp  and  contact  configuration  without  violating  stability  or  joint  limit  criteria.  As 
mentioned  in  Section  5.2,  an  ideal  grip  (geometric  center  of  net  SAS  end  error  region  co¬ 
located  over  the  cylinder  center  point)  cannot  be  achieved  for  the  hand  model.  In  this 
example,  the  net  SAS  region  satisfies  the  specified  degree  of  robustness  while  preserving 
the  cylinder  center  point;  thus  the  grasp  is  acceptable.  Section  5.6  will  examine  in  greater 
detail  why  the  cylinder  center  point  is  the  desirable  location  for  the  grasp  focus. 

5.5  Effects  of  Contact  Location  on  S/lS  Region 

The  results  so  far  are  only  applicable  to  a  specific  contact  configuration  {i^q  =  90°, 
i/-!  =  -50°,  i/'t  =  -130°}.  The  question  is  whether  a  different  contact  configuration  will 
provide  similar  results.  Generally  speaking,  the  retracted  grasp  is  still  preferred  over  an 
intermediate  or  extended  grasp,  regardless  of  the  contact  configuration.  This  is  due  to  the 
shorter  moment  arm,  and  thus  smaller  Joint  torques.  TTie  real  question  is  whether  a  finger- 
bias  grasp  still  results  in  a  larger  net  SAS  region. 
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Figure  5-14,  Retracted  Finger-Bias,  Max.  Torque,  50*  Rotation 


Figure  5-15.  Retracted  Finger-Bias.  =•  30°;  Max.  Torque.  50°  Rotation 


Figure  5-16.  Retracted  Finger-Bias,  <p^^  =  20®;  Max.  Torque,  50°  Rotation 


Figure  5-17,  Retracted  Finger-Bias,  <t>^,  -  5°,  Max.  Torque,  50°  Rotation 
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Figure  5-18.  Retracted  Finger-Bias,  =  0°;  Max.  Torque,  50®  Rotation 


Figure  5-19.  F-Je;  SAS  Region  for  Retracted  Finger-Bias  Grasp;  Maximum  Tort  le, 
50°  Rotation 
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5.5.1  Retracted  Finger-Bias  Grasp  with  Symmetric  Contacts.  To  examine  this 
question  the  contact  locations  are  changed  to  =  90°.  i/’,  =  -30°,  \p2  ~  -150°}  or  to 
symmetric  contacts.  The  cylinder  is  aligned  using  the  same  retracted  finger-bias  grasp  and 
Cmap  value  of  .4891  11^^  "1^=79.65  N,  r^=  27.46  mm)  that  was  used  in 

Section  5.4.2.  Constraint  maps  arc  generated  for  =  30°,  20°,  -20°,  and  -30°,  and 
Figures  5-20  through  5-23  depict  the  resulting  constraint  maps. 

The  obvious  difference  is  the  shape  of  the  stable  region.  Its  symmetric  shape 
corresponds  with  the  contact  symmetry.  However,  the  symmetry  is  a  mirror  image  about 
the  vertical  axis.  This  type  of  phenomena  is  characterized  by  Edwards  13:p4-2  to  4-7).  At 
a  smaller  external  moment  magnitude,  the  stable  region  is  completely  symmetric  (i.e.  not  a 
mirror  image).  As  the  external  moment  is  increased,  the  stability  or  111  contact  code 
boundary  lines  move  inward  at  equal  rates  from  the  corresponding  contacts  towards  the 
center.  This  in  essence  "chops"  the  corners  of  the  original  triangular  shape  and  results  in 
a  mirror  image. 

The  other  notable  difference  is  the  SAS  region  is  smaller  in  the  first  half  of  rotation 
than  the  second  half  of  rotation.  The  is  an  opposite  trend  from  the  previous  contact 
configuration.  Note  that  the  reduction  is  caused  by  J22  and  not  J20.  This  suggests  that 
the  cylinder  is  bias  too  far  towards  Fingers  1  and  2. 

Before  examining  another  bias  position,  we  should  compare  the  net  SAS  region 
(identical  to  Figure  5-20)  with  the  corresponding  "equivalent"  region  using  the  previously 
examined  contact  configuration.  An  equivalent  comparison  can  be  made  by  examining 
SA.'  gion  over  the  same  rotation  range  (60°).  Figures  5-10  and  5-1 1  (<5^  =  50°  to  -20°) 
show  that  the  SAS  region  is  the  same  size  as  the  stable  region  for  a  minimum  rotation 
range  of  70  degrees.  This  results  a  far  better  net  SAS  region  than  the  net  SAS 
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Figure  5-20.  Retracted  Finger-Bias  Grasp,  Symmetric  Contacts;  = 


Figure  5-21.  Retracted  Finger-Bias  Grasp.  Symmetric  Contacts;  <^>[,=20® 
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Figure  5*22.  Retracted  Finger-Bias  Grasp,  Symmetric  Contacts, 


Figure  5-23.  Retracted  Finger-Bias  Grasp,  Symmetric  Contacts,  <Pb=-30° 
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region  using  a  symmetric  contact  configuration.  This  also  suggests  that  the  symmetric 
contact  grasp  is  not  properly  positioned. 

5.5.2  Retracted  Thumb-Bia.s  Grasp  with  Symmetric  Contacts.  Using  the  same 
value,  the  grasp  is  repositioned  to  a  retracted  thumb-bias  grasp  (slightly  thumb-bias, 

<i3=28  mm).  Figures  5-24  and  5-25  show  the  resulting  maps  for  =  {30°,  -30°}.  Only 
tv/o  samples  are  necessary  since  the  SAS  region  remains  unchanged  over  the  entire  rotation 
range.  In  fact,  the  SAS  region  is  the  same  as  the  stable  region.  This  is  a  significant 
improvement  over  the  finger-bias  grasp.  This  confirms  the  suspicion  that  a  finger-bias 
grasp  is  not  necessarily  the  best  cylinder  position  for  all  contact  configurations. 

This  time  the  maximum  torque  case  for  the  finger-bias  grasp  in  Section  5.4.2  will  be 
compared  with  the  thumb-bias  grasp  with  symmetric  contacts.  The  contact  configuration 
for  the  finger  bias  grasp  {\Pq  =  90°,  \p^  =  -50°,  •/'2  =  -130°}  is  termed  semi-symmetric 
since  two  of  the  three  contact  separation  angles  are  the  same.  To  equally  compare  the  two 
different  contact  configurations,  we  will  make  the  same  focus  positioning  assumptions 
made  in  Section  5.4.2.  Using  the  same  value  (A/gj,  =  1.2  Nm  and  m^  =  89.33  N) 
two  sample  maps  are  generated  at  0^,  =  (30°,  -30°}.  The  two  maps  (Figures  .5-26  and  5- 
27,  RTB  =  Retracted  Thumb-Bias)  correspond  to  the  two  extremes  for  the  SAS  region. 

The  net  SAS  region  for  the  symmetric  contact  grasp  is  shown  in  Figure  5-28.  The 
net  region  is  smaller  than  the  net  region  in  Figure  5-19,  which  is  based  on  semi-symmetric 
contacts.  Flowever,  the  proportional  area  surrounding  the  cylinder  center  point  is  slightly 
larger.  In  addition  the  net  region  for  the  symmetric  contact  case  is  valid  for  a  60°  rotation 
range.  The  net  region  for  the  semi-symmetric  contact  case  is  only  valid  for  a  50°  rotation; 
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Figure  5-25.  Retracted  Thumb-Bias  Grasp,  Symmetric  Contacts;  <!^  =  -30' 
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Figure  5-26.  RTB  Grasp.  Symmetric  Contacts,  0^  =  30®;  High  Torque 


Figure  5-27.  RTB  Grasp.  Symmetric  Contacts,  High  Torque 
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Figure  5*28.  Net  SAS  Reg’on  for  Retracted  Thumb-Bias  Grasp  w/Symmetric  Contacts 


although  the  ranee  can  be  increased  since  the  net  region  is  larger  than  the  net  region  for 
the  symmetric  contact  grasp. 

Choosing  between  the  two  contact  configurations  is  dependent  on  where  one 
specifies  the  desired  focus  point  location,  since  the  their  rotation  ranges  are  similar.  If 
center  point  focus  location  is  specified  then  symmetric  contact  are  preferred,  since  there  is 
more  room  for  error.  If  the  focus  can  be  positioned  in  the  center  of  the  net  SAS  region  to 
maximize  robustness,  then  semi-symmetric  contact  might  be  preferred  since  the  region  is 
wider.  This  leads  us  into  the  last  section  of  this  chapter  to  determine  the  advantages  and 
disadvantages  of  focus  location. 
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i.  6  Locating  the  Grasp  Focus 

The  previous  sections  provided  the  understanding  of  how  the  SAS  net  region  evolves 
as  the  cylinder  is  rotated  using  different  grasp  and  contact  configurations.  We  will  now 
sample  different  focus  locations  within  the  stable  region  to  determine  the  relationship 
between  contact  forces  and  focus  location.  As  mentioned  at  the  beginning  of  this  chapter, 
tile  objective  is  two-fold.  The  first  is  to  gain  some  insight  as  to  what  determines  the  shape 
of  the  SAS  region.  The  second  is  to  prove  that  the  cylinder  center  point  is  the  optima! 
focus  Iccnticn  for  increased  torquing  capability. 

A  comparison  i:  made  between  the  stable  regions  for  the  finger-bias  grasp  with 
semi-symmetric  contacts  in  Section  5.4.2  and  the  thumb-bias  grasp  with  symmetric 
contacts  in  the  Section  5.5.2.  An  equally  spaced  9-point  grid  is  overlaid  over  the  two 
regions  in  the  same  manner.  The  square  grid  is  positioned  over  the  cylinder  center  and  the 
grid  point  spacing  is  such  that  its's  outer  points  reach  to  or  slightly  past  the  stable  region 
boundary  line.  The  identical  grid  overlays  for  the  two  regions  are  shown  in  Figures  5-29 
and  5-30. 

Each  of  the  grid  points  are  numbered  from  left  to  right,  starting  at  the  top  of  the 
grid.  Tables  5-1  and  5-2  list  the  discrete  values  for  the  forces  at  each  contact  for  the  semi- 
symmetric  contact  grasp.  Tables  5-3  and  5-4  list  the  discrete  values  for  the  forces  at  each 
contact  for  the  symmetric  contact  grasp.  For  both  contact  configurations  the  total 
tangential  force  component  must  satisfy  the  stability  constraint: 

X.j.  s  ix  Zjj  (5.2) 
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Figure  5-30.  Stable  Region  Grid  For  Retracted  Thumb-Bias  Grasp 
with  Symmetric  Contacts 
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Table  5-1.  Contact  Forces  for  Grid  Points  1  through  5;  Semi-Symmetric  Contacts 


Contact 

Force 

Component 

Force  Magnitude  (N)  at  Grid  Point  {x,y} 

1 

{-.  +  } 

2 

'0.  +  } 

3 

{ +.  +  } 

4 

{-.0} 

5 

{0.0} 

^01 

-3,11 

-2. S3 

-2.57 

0 

0 

1  ^OE 

-18.95 

-18.95 

-18.95 

-18.95 

-18.95 

^OT 

-22.06 

-21.78 

-21.52 

•18.95 

-18.95 

^01 

39.64 

38.87 

37.93 

39.53 

38.75 

!  ^OT'^^OI  1 

i 

0.94 

0.95 

0.96 

0.81 

D 

1  ^11 

2.95 

1.7 

0.29 

1.1 

0 

rr 

-12.37 

-12.37 

-12.37 

-12,37 

-12.37 

XjT 

-9.42 

-10.67 

-12.08 

-11.27 

-12,37 

^11 

28.99 

29.03 

29,13 

24.89 

25.29 

M 

0,55 

1 _ 

0,62 

0,70 

0.77 

m 

^:i 

B 

1.13 

2,28 

■1,1 

0 

^2B 

B 

■12.37 

-12.37 

-12,37 

-12.37 

Xyy 

B 

-11.24 

-10.09 

-13.47 

-12.37 

2:, 

20.43 

21.25 

22.06 

24,88 

25,29 

1  X2j/Z2\  1 

M 

1.01 

1 

1 

1  .. 

0,90 

0.77 

0.92 

0.83 

5-32 


Table  5-2.  Contact  Forces  for  Grid  Points  6  through  9;  Serni-Symmetr'c  Contacts 


Force  Magnitude  (N)  at  Grid  Point  {x,y} 

Contact 

Force 

6  7 

8 

9 

Component 

{  +  .0} 

{0.-} 

■^01 


i  i 


Z 


0 

3.11 

2.83 

2.57 

-18.95 

-18.95 

-18.95 

-18.95 

-18.95 

-15.84 

-16.12 

-16.38 

37.79 

39.64 

38.87 

37.93 

0.85 

0.68 

0.70 

0.73 

-1.28 

-0.17 

-1.13 

-2.28 

-12.37 

-12.37 

-12.37 

-12.37 

-13.65 

-12.54 

-13.50 

-14.65 

25.74 

20.43 

21.25 

22.06 

0.90 

1.04 

1 

1 

1.08 

1.13 

1.28 

-2,95 

■1.7 

-0.29 

-12.37 

-12.37 

-12.37 

-12.37 

-11.09 

-15.32 

-14.07 

-12.66 

25.74 

28.99 

29.03 

29,13 

0.73 

0.89 

0.82 

0.74 
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Table  5-3.  Contact  Forces  for  Grid  Points  1  through  5;  Symmetric  Contacts 


Conmci 

Force 

Component 

Force  Magnitude  (N)  at  Grid  Point  {x.y} 

1 

{-.  +  } 

2 

{0.  +  } 

3 

{  +  .  +  ) 

4 

{-.0} 

5 

{0,0} 

^01 

-2.5 

-2.18 

-1.87 

0 

0 

■^OE 

-14.56 

-14.56 

-14.56 

-14.56 

-14.56 

■^OT 

-17.06 

-16.74 

-16.43 

-14.56 

-14,56 

2oi 

31.87 

29.9 

27.52 

31.76 

29.78 

1  •^OT^^OI  1 

0.91 

■ 

1.01 

0.96 

0.83 

^11 

3.14 

Ei 

-0.96 

1.75 

0 

■^Ib 

-14.56 

•14.56 

•14.56 

•14.56 

-14.56 

XiT 

-11.42 

-13.33 

-15.52 

-12.81 

■14,56 

2ll 

30.76 

31.54 

32.41 

28.73 

29.78 

|X,T/Z„i 

0.63 

0.72 

0.81 

0.76 

0.85 

-0.64 

0.95 

2.83 

-1,75 

0 

‘^2E 

-14.56 

-14.56 

-14.56 

•14,56 

-14,56 

i 

-15.12 

-13.61 

-11.73 

-16,31 

•14,56 

[  ^21 

26.42 

27.77 

29.18 

28.73 

29.78 

1  X'i'|*/Z-i|  1 

0.97 

0.83 

0.68 

0.78 

0.83 
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Table  5-4.  Contact  Forces  for  Grid  Points  6  through  9;  Symmetric  Contacts 


5-35 


v^here 


The  shaded  boxes  in  Tables  5-1  through  5-4  represent  the  contact  locations  which 
violate  Equation  5-2.  This  is  graphically  confirmed  by  the  constraint  maps  in  Figures  5-29 
and  5-30.  A  simple  method  to  interpret  the  contact  force  information  in  the  tables  is  to 
calculate  and  compare  the  value  of  to  the  friction  coefficient  Rearranging 

equation  5.2  and  realizing  that  2jj  is  equal  to  Zj|  (reference  Section  3.5): 


The  ratio  in  Equation  5.3  must  be  less  than  one  to  avoid  contact  slip.  As  the  ratio 
approaches  one.  the  potential  for  slip  increases;  for  discussion  define  the  calculated  ratio  as 
the  slip  poieniiul  for  the  contact  point.  Since  the  contact  point  will  no»  actually  slip  uiitil 
the  ratio  equals  one,  the  slip  potential  is  merely  a  quality  measure  for  comparison 
purposes.  The  slip  potential  is  calculated  for  each  of  the  nine  grid  points  and  listed  in 
Tables  5-1  through  5-4. 

Using  the  definition  of  the  slip  potential,  there  are  several  key  items  to  note 
concerning  focus  location.  Most  notable  is  that  at  the  cylinder  center  point  (grid  point 
five),  each  of  the  contacts  points  have  the  same  slip  potential.  This  is  true  regardless  of 
contact  configuration.  Having  equal  potentials  implies  that  when  the  conditions  for  slip 
exist,  all  three  contact  points  will  slip  at  the  same  time.  This  is  a  predictable  feature;  a 
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feature  which  does  not  require  advance  calculation  since  it  is  independent  of  contact 
configuration. 

At  point  locations  other  than  the  cylinder  center,  the  slip  potential  for  a  given 
contact  is  different  from  the  other  two  contacts.  The  resulting  values  are  unique  for  each 
contact  point  and  a  function  of  contact  configuration.  For  example,  compare  grid  point 
seven  for  the  two  contact  configurations.  The  slip  potential  for  each  contact  using  semi- 
symmetric  contacts  (reference  Table  5-2)  changes  significantly  if  the  contact  configuration 
is  switched  to  symmetric  contacts  (Table  5-4)  even  though  the  focus  location  is  the  same. 
Also  note  that  in  the  semi-symmetric  case.  Finger  1  has  the  highest  slip  potential.  At  the 
same  point  using  symmetric  contacts.  Finger  2  has  the  highest  slip  potential.  Unlike  the 
cylinder  center  point,  which  finger  will  slip  first  cannot  be  predicted  without  discrete 
calculations  at  the  specific  focus  point. 

The  cylinder  center  point  also  has  a  computational  advantage  over  any  other  point  in 
the  grasp  plane.  Since  the  slip  potential  is  the  same  for  each  contact,  the  value  need  only 
be  calculated  once.  With  this  value  the  contact  forces  for  the  remaining  two  contact  points 
can  be  easily  calculated.  Equations  3.5  and  3.10  are  normally  required  to  calculate  the 
total  contact  force.  Equation  3. 10  is  complex,  but  can  be  avoided  for  the  other  two 
contact  points.  Equation  3.5  can  be  used  to  calculate  Xjg,  which  is  equal  to  Xjj.  Using 
the  calculated  value  for  the  slip  potential  and  Equation  5.3,  Z^^=Z^J  can  be  easily 
calculated. 

At  the  cylinder  center  point,  the  x-compnnent  of  the  homogeneous  or  internal  contact 
force  .solution  is  zero  for  each  of  the  ihree  contact  points.  Again,  this  is  independent  of 
contact  configuration.  At  this  point  the  x-component  of  the  total  contact  force  is  equal  to 
X^r  only,  the  force  necessary  to  oppose  the  external  moment.  Therefore,  tlte  total  contact 
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force  is  used  only  to  oppose  the  external  moment  (Xj£)  or  to  maintain  grasp  stability 
At  any  other  point,  the  x-component  of  the  internal  contact  for':e  exists  for  at  least  two  of 
the  fingers.  This  implies  that  part  of  the  internal  grasp  force  is  used  to  do  non-useful 
work;  i.e.  the  fingers  are  working  against  each  other.  A  conclusion  can  be  made  that  the 
cylinder  center  point  is  the  most  efficient  point  for  locating  the  grasp  focus.  This  confirms 
Edwards  statement  that  the  cylinder  center  point  is  the  optimal  focus  location  for  increased 
torquing  capability. 

The  slip  potential  can  also  be  used  to  examine  the  shape  of  the  stable  region  for  each 
of  the  contact  configurations.  We  will  examine  the  slip  potential  ,  5  a  function  of  grid 
point  location.  First  select  the  contact  point  with  the  maximum  slip  potential  at  each  grid 
point  location.  These  values  are  listed  in  boid  type  in  Table  5-1  through  5-4.  Now 
compare  these  values  with  the  shape  of  th'  corresponding  stable  region  shown  in  Figure  5- 
29  or  Figure  5-30.  Note  the;  the  '  '  •  •:'ch  the  shape  of  the  region.  This  is  as 

expected  since,  by  definition,  the  shape  of  the  stable  region  is  determined  by  the  no¬ 
contact-slip  stability  criteria. 

Due  to  the  complexity  of  the  grasp  equations  (Equation  3.5  and  3.10)  and  the 
inclusion  of  the  external  moment,  it  is  difficult  to  explain  exactly  why  the  stable  region  is 
shaped  as  it  is.  In  addition,  it  is  the  shape  of  net  SAS  region  which  ultimately  defines 
whether  the  grasp  can  successfully  complete  the  task.  If  joint  torque  limits  are  violated, 
any  symmetry  contained  in  the  stable  region  is  removed  by  torque  limit  lines.  However,  a 
basic  understanding  of  how'  contact  configuration  effects  the  shape  of  the  stable  region  is 
still  important  for  grasp  planning  purposes.  Two  general  statements  can  be  made 
concerning  the  relationship  between  contact  configuration  and  the  shape  of  the  stable 
region: 
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1)  If  the  contact  locations  are  symmetric,  the  stable  region  will  be  symmetric  about 
the  horizontal  axis  of  the  contact  plane  (axis  containing  contact  point  for  Finger  0 
and  the  cylinder  center  point)  and  will  enclose  the  cylinder  center  point. 

2)  If  the  contact  locations  are  semi-symmetric,  the  stable  region  will  have  no 
symmetry,  but  will  enclose  the  cylinder  center  point.  In  addition,  if  the  external 
moment  is  counter-clockwise,  the  region  will  be  bias  towards  Finger  1;  if  it  is 
clockwise,  the  region  will  be  bias  towards  Finger  2 

5.  7  Summary 

Generating  constraint  maps  for  various  grasp  configurations  provides  a  basic 
understanding  of  how  the  SAS  region  evolves  over  a  given  cylinder  rotation  range.  Three 
primary  grasp  configurations  (retracteo,  intermediate,  and  extended)  vere  examined  to 
deterr  ine  the  effects  of  cylinder  proximity  on  the  net  SAS  reg;  addition,  three 
diffeiei.  .ypes  of  bias-grasps  we  examined  to  determine  the  effects  of  cylinder  biasing  on 
the  net  SAS  region.  The  graphical  analysis  reveled  that  positioning  the  cylinder  as  close 
as  possible  to  the  palm  results  in  a  large  SAS  region.  However,  biasing  the  cylinder 
towards  a  .pecific  finger  to  maximize  the  size  of  the  net  SAS  region  is  dependent  on  the 
grasp  configuration. 

Adjusting  the  grasp  such  that  the  net  SAS  region  is  maximized  is  desirable  since  it 
implies  that  the  grasp  configuration  is  then  capable  of  opposing  a  highest  level  of  external 
torque.  In  addition,  designing  the  grasp  such  that  the  net  SAS  region  encloses  the 
specified  error  insures  that  the  grasp  is  robust  for  the  entire  manipulation  task.  The 
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general  relationships  for  cylinder  proximity  and  cylinder  bias  were  used  to  demonstrate  a 
method  for  designing  a  robust  grasp  for  high  torque  applications. 

The  results  also  determine  the  effects  of  contact  configuration  on  the  net  SAS  region. 
Two  different  contact  configurations,  semi -symmetric  and  symmetric,  were  compared.  It 
was  determined  that  for  semi-.symmetric  contact  locations,  a  finger-bias  grasp  maximizes 
the  net  SAS  region.  However,  if  symmetric  contacts  are  used  then  the  maximum  net  SAS 
region  occurs  with  a  thumb  bias  grasp.  The  comparison  was  made 
using  equal  external  moment  and  ^rasp  force  magnitudes,  along  with  similar  rotation 
ranges.  T.he  .na'  i.-n-irn  ne;  S.-aS  region  for  the  serni-symmetric  contact  grasp  is  larger  than 
the  correspond ir.g  region  for  the  symmetric  contact  grasp;  although  the  pii,rcrtional  area 
about  the  cylinder  center  point  is  slighilv  smaller  than  the  same  area  type  using  symmetric 
contacts. 

The  evolution  of  the  SAS  region  was  also  shown  to  be  dependent  on  the  contact 
configuration.  For  a  finger-t  ias  grasp  witli  semi-symmetric  contacts,  the  SAS  region 
reduces  in  size  as  the  fingers  rotate  the  cylinder.  In  general,  the  size  SAS  region  is  at  a 
maximum  during  the  first  phase  of  rotation  and  decreases  to  a  minimum  size  at  the  final 
phase.  This  implies  that  the  maximum  torquing  capability  of  this  grasp  and  contact 
configuraiion  is  at  the  beginning  of  the  cylinder  rotational  movement. 

For  a  thumb-bias  grasp  with  symmetric  contacts,  the  size  of  the  SAS  region  reaches 
a  maximum  during  the  mid-point  phase  of  rotation.  At  *he  start  of  rotation,  the  SAS 
region  is  reduced  in  size  by  the  second  joint  on  Finger  2.  At  the  end  of  rotation,  the  SAS 
region  is  similarly  reduced  in  size,  but  this  time  by  the  second  joint  on  Finger  0.  This 
type  of  trend  suggests  that  the  net  SAS  region  can  be  maximized  by  using  a  thumb-bias 
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grasp  during  the  first  phase  of  rotation  and  then  transitioning  to  a  finger-bias  grasp  as  the 
cylinder  progresses  towards  the  final  phase  of  rotation. 

An  examination  of  the  contact  forces  at  specific  points  reveled  that  the  cylinder 
center  point  is  the  most  efficient  location  for  the  grasp  focus.  In  addition,  at  the  cylinder 
center  point  the  slip  potential  is  the  same  for  each  of  the  three  contact  points.  This  implies 
that  all  three  contact  points  will  approach  the  point  of  slip  at  the  same  rate.  The  feature  of 
equal  slip  potentials  can  be  exploited  to  ease  the  computational  burden  in  calculating  the 
total  contact  force  for  two  of  the  three  contact  locations.  Ail  of  these  statements  are  true 
regardless  of  contact  configuration. 
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VI.  Conclusions 


The  study  conclusions  are  partially  restricted  since  Lhey  pertain  to  a  specific  hand 
model,  and  a  limited  number  of  grasp  and  contact  configurations.  However,  the  hand 
model  employed  is  based  on  one  of  the  few  existing  robotic  hands  actively  utilized  in 
robotic  research.  In  addition,  the  tj  pes  of  grasp  and  contact  configurations  examined  are 
common  to  those  used  for  typical  task  applications.  Therefore,  the  results  and  techniques 
presented  provide  useful  information  and  general  relationships  for  use  in  grasp  planning. 
Given  a  specific  task,  die  constraint  mapping  procedure  can  be  used  to  determine  single 
grasp  focus  location  which  satisfies  all  grasp  criteria. 

Constraint  maps  were  used  to  determine  how  the  safe  and  stable  region  evolves  as 
the  fingers  rotate  the  cylinder  about  its  transverse  axis,  while  opposing  an  external  torque. 
The  safe  and  stable  region  (SAS)  represents  an  area  of  all  possible  grasp  force  focus 
locations  v/hich  satisfy  grasp  stability  and  joint  torque  limit  criteria  at  a  specific  rotation 
increment.  The  intersection  of  all  SAS  regions  at  each  rotation  increntent  results  in  a  net 
SAS  region  in  which  all  points  satisfy  the  criteria  over  the  entire  rotation  range. 

Examining  retracted,  intermediate,  and  extended  three-finger  precision  grasps 
determined  the  relationship  between  cylinder  proximity  and  the  evolution  of  the  SAS 
region  over  the  cylinder  rotation  range.  The  graphical  analysis  revealed  that  the  net  SAS 
region  is  smallest  in  size  for  an  extended  grasp,  and  largest  in  size  w'hen  the  grasp  is  in  a 
retracted  configuration.  This  implies  that  a  retracted  grasp  is  the  "strongest"  single  grasp 
type  for  applying  torque  as  the  cylinder  is  rotated.  Presented  the  option,  the  best  way  to 
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improve  the  torquing  capability  of  a  given  grasp  is  position  the  cylinder  as  close  as 
possible  to  the  hand.  This  particular  relationship  is  independent  of  hand  design. 

Minor  improvements  in  the  size  of  the  net  SAS  region  can  be  obtained  by  biasing 
the  cylinder  towards  the  thumb,  opoosing  fingers,  or  leaving  it  in  a  neutral-bias  to 
position.  Which  type  of  bias  position  to  use  is  dependent  on  the  type  of  contact 
configuration.  For  the  study  hand  model,  the  results  demonstrated  that  a  finger-bias 
position  v/ill  maximize  the  net  SAS  region  if  the  contact  locations  are  semi-symmetric. 

For  symmetric  contact  locations,  a  thumb-bias  cylinder  position  will  maximize  the  net  SAS 
region. 

The  analysis  consistently  demonstrated  that,  regardless  of  grasp  or  contact 
configuration,  the  second  joint  on  the  thumb  or  "Finger  0"  was  the  most  sensitive  to  the 
commanded  contact  force.  At  high  values,  the  joint  exceeds  its’  torque  limit  and 
reduces  the  size  of  the  net  SAS  region.  This  characteristic  is  unique  to  the  hand  model 
dimensions  and  joint  torque  limits  employed.  Different  model  or  limit  parameters  will 
reveal  different  results.  If  one  was  to  redesign  the  hand  based  on  this  study,  the  results 
imply  that  the  last  two  links  on  the  if  urnb  should  be  reduced  in  length  cr  the  maximum 
tendon  tension  for  joint  tw'o  should  be  inc.^eased. 

Choosing  between  symmetric  or  semi-symmetric  contact  locations  is  dependent  on 
the  specific  task  application  and  where  the  de.^ired  focus  location  resides.  If  the  primary 
task  objective  is  to  maximize  the  cylinder  rotation  range,  clearly  semi-svinmetric  contacts 
iu'c  preferred.  Thi.s  assumes  that  the  rotation  range  is  limited  by  not  allowing  the  contact 
point  to  rotate  onto  the  top  or  "fingernail"  portion  of  the  finger-tip.  li  was  also  observed 
that  semi-syinmclric  contacts  also  possess  a  unique  quality;  the  ,S,AS  region  is  largest  in 
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size  during  the  beginning  phase  of  rotation.  This  attribute  can  be  exploited  for  task 
applications  which  require  high  torquing  capability  at  the  start  of  rotation,  such  as 
loosening  an  oil  filter.  Once  the  filter  breaks  free,  the  contact  layout  allows  for  large 
rotation  ranges  for  rapidly  removing  the  filter. 

Symmetric  contact  configurations  are  useful  for  tasks  in  which  there  may  be 
significant  external  disturbances.  The  symmetric  layout  of  the  contacts  allow  for  equal 
resistance  to  disturbances  in  both  directions  of  the  grasp  plane.  This  configuration  is  .most 
applicable  to  mating  tasks  such  as  attaching  an  oil  filter  onto  a  threaded  post.  The 
evolution  of  the  SAS  region  for  symmetric  contacts  also  suggests  that  a  larger  net  SAS 
region  can  be  r>btained  by  changing  the  cylinder-bias  during  the  rotational  movement.  At 
the  beginning  of  rotation,  a  thumb-bias  grasp  will  maximize  the  SAS  region;  at  »he  end  of 
rotation,  a  fnger-bias  grasp  will  maximize  the  SAS  region.  The  results  also  demonstrated 
that  symmetric  contacts  are  preferred  if  the  grasp  focus  is  to  be  located  at  the  cylinder 
center. 

The  analysis  revealed  that  the  cylinder  center  point  is  the  most  efficient  location  for 
the  grasp  focus.  At  this  point  the  contact  forces  are  used  purely  to  do  useful  work  by 
holding  the  cylinder  and  opposing  the  external  moment.  With  a  high  grasp  efficiency,  the 
fraction  of  contact  force  available  for  opposing  external  moments  and  disturbances  is  at  a 
maximum.  In  addition,  if  the  focus  is  located  at  the  center  point,  all  three  contact  points 
will  approach  the  point  of  slip  at  the  same  rate.  This  characteristic  can  be  exploited  to 
ease  the  computational  burden  in  calculating  the  total  contact  force  for  two  of  the  three 
contact  locations  Each  of  these  attiibutes  are  independent  of  contact  configuration. 

For  an  ideal  grip,  the  net  SAS  region  is  equal  in  size  and  shape  to  that  for  the  error 
region.  With  this  condition,  the  two  regions  can  be  centered  directly  over  the  center  of  the 
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cylinder  to  achieve  the  maximum  combination  of  grasp  torquing  capability  and  robustness. 
Tlie  results  dcmonsirated  that  'he  ideal  grip  cannot  be  achieved  with  the  hand  model 
employed  Howe'ei ,  using  'he  constraint  mappitr  .'rocedure  and  the  generai  relationships 
presented,  an  acceptable  grasp  configuration  can  always  be  achieved.  The  general 
relationships  beiweeii  the  simulated  cylinder  threading  task  and  the  grasp  parameters  are 
listed  in  Table  6-1 

Tlie  relationships  in  Table  6-1  can  oc  used  te  design  a  robust  grasp  with  high 
torquing  capability.  rcracttci  grasp  configuration  is  the  best  grasp  for  positioning  the 
cylindei  relative  to  the  hand  This  provides  the  greatest  gain  towards  increasing  the  size 
of  the  net  SAS  region.  Tne  contact  configuration  can  be  matched  to  the  task  applicacion, 
and  die  correct  cylinder-biasing  can  be  derived  to  maximize  the  size  of  the  net  SAS  region. 
Designing  a  robust  grasp  foe  high  torque  applications  is  accomplished  by  maximizing  the 
ratio  of  the  external  moment  to  the  grasp  force  magnitude  and  cylinder  radius 
The  "target"  size  of  the  net  region  corresponds  to  the  amount  of  focus  positioning  error 
inherent  in  the  actual  hand  controller.  The  error  region  is  centered  over  the  cylinder 
center  point  to  nij.ximizc  grasp  efficiency  and  take  advantage,  of  the  predictable  contact  slip 
chatact'..risMcs  ureque  to  this  point.  1  he  coristraint  mapping  piocedure  can  be  used  to 
meLhocically  .'•c  uice  tine  net  .S’A^.  region  and  eiucompass  the  enor  region.  The  resulting 
grasp  is  robust  ano  st.abie  throughout  the  manipulation  task. 

TTie  study  objective  vs  as  to  develop  a  planning  procedure  for  grasping  and 
manipulating  a  cylinder  u.sing  a  tiuce-finger  precision  grasp.  '016  objective  was 
successfully  ai  com[ili.shed  and  demonarated  using  a  model  ot'tne  Utah/MIT  Dexterous 
Hand  Tiie  analysis  simulate.i  the  task  of  rotating  a  cylinder  about  a  threaded  post  while 
opposing  an  external  ic.oincnt.  The  co'i.cinec  effects  of  applied  torque,  contact  location. 
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Table  6-1.  Threa.iing  Task  Characteristics  VS  Grasp  Parameters 


CHAR. 

PARAM 

1 

1 

Torque  Capability 

Rotation  Range 

Robustness 

Cylinder  Bias 

Use  to  Maximize 

Use  to  Maximize 

Thuml>  Bias 

Dependent  on; 

Dependent  on: 

-  Neutral  Bias 

-  Hand  Design 

-  Hand  D'— .:g.i 

-  Fini.cr  Bias 

-  C«5ntaci  Location 

-  Cor.LacI  Location 

Cylinder  Proximity 

Retracted  Stronges' 

Use  Retracted  Grasp 

•  Retracted 

Extend'  d  W<:at:cst 

•  tntrnncdiatc 

Extended 

Opt.  Point  at  Ccr.'.er 

Focus  Location 

Optimum  Point  at 

Not  EffeeteJ  if  Located 

of  Net  SAS  Region 

Objet'  Center 

In  Net  SAS  Region 

Use  symmetric  for 

Use  Scmi-Symmelnc  for 

Use  Symniciric  to  Preserve 

ConUic! 

Mating  Tasks 

Muximoin  RoUt.on  Range 

Area  About 

Loea'.i'  1 

Object  Center  Point 

Use  Semi-Syi  .iViCtriv  to 

1 

Looseii  Tighten '  -r  lor 

Ooiek  Remov.tl  Tasks 

1 


and  object  positioii  and  orientation  on  grasp  stability  and  robustness  were  analyzed  using 
the  method  of  grasp  force  focus  positioning.  The  procedure  from  this  study  can  be  used  to 
detern^iine  a  single  grip  which  guarantees  grasp  stability,  robustness,  and  high  torquing 
capability  for  the  task.  The  procedure  can  also  be  used  to  analyze  the  resulting  effects  of 
hand  design  changes  or  new  hand  designs. 
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VII.  Recommendations 


7.  ]  Verification  of  Procedure 

The  results  of  this  study  would  be  put  to  greatest  use  by  verifying  the  relationships 
and  procedure  presented.  This  could  be  accomplished  using  the  Utah/MIT  Dexterous 
Hand,  which  is  readily  available  in  the  AFIT  Robotics  Lab.  The  most  difficult  aspect  of 
the  verification  would  be  determining  w'here  the  actual  robot  hand  is  positioning  the  grasp 
focus.  A  thorough  understanding  of  the  sensor  and  controller  limitations  is  required. 

7.2  Examininf!  Additional  Model  Parameters 

The  are  several  more  parameters  which  can  be  examined  in  a  future  study.  An 
interesting  and  useful  parameter  to  include  is  the  modelling  of  rolling  contacts.  For  large 
cylinder  rotation  angles,  rolling  contacts  can  have  a  significant  effect  on  the  size  and  shape 
of  the  safe  and  stable  region.  Even  an  approximate  model  would  be  useful  since  it  is  a 
closer  representation  of  the  actual  hand  than  a  point  contact  model  assumption.  There  are 
several  other  items  which  can  be  examined.  One  is  the  effects  of  non-symrnetric  contact 
locations  on  the  SAS  region.  The  other  is  the  effects  of  biasing  the  cylinder  in  a  direction 
which  is  parallel  a  line  joining  the  base  joints  of  Fingers  1  and  2  (onhogonal  direction  to 
the  bias  studied).  Different  hand  dimension.s  can  also  be  examined.  One  idea  is  to  design 
a  several  hands  for  specific  cylinder  sizes. 
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'/.  j  Customizing  Joint  Torque  Limits 

The  joint  torque  limitations  were  constant  in  this  study  and  assumed  zero  co¬ 
contraction  of  the  tendons.  With  a  zero  co-contraction  setting,  the  fingers  of  the  hand 
have  no  stiffness.  For  real-time  implementation  tasks,  finger  stiffness  is  required. 
Therefore,  a  useful  update  to  the  grasp  planning  procedure  would  be  the  inclusion  of 
stiffness  criteria. 

For  the  limits  used  in  this  study,  joint  two  of  the  fingers  was  typically  the  weakest 
joint.  This  implies  that  the  joint  limits  for  other  joints  are  set  too  high.  The  constraint 
mapping  technique  can  be  used  to  adjust  the  jo*nt  torque  limits  for  each  individual  joint. 
One  method  is  to  overlay  a  series  of  joint  torque  limit  lines  for  each  joint  onto  a  map  ot 
the  stable  region  and  desired  error  region.  Each  joint  torque  limit  line  is  based  on  a 
specific  joint  torque  limit.  The  lines  closest  to  the  error  region  correspond  to  the  desired 
joint  torque  limit  values.  The  reduced  joint  torque  margin  for  each  joint  can  be 
redistributed  to  satisfy  a  specified  stiffness  criteria. 

The  effects  of  adjusting  the  joint  torque  limits  on  the  size  and  shape  of  the  net  SAS 
region  can  also  be  examined.  The  primary  goal  would  be  to  make  the  size  and  shape  of 
the  net  SAS  region  identical  to  that  for  the  error  region.  In  addition,  the  geometric  center 
of  the  two  regions  should  be  collocated  over  the  cylinder  center  point.  This  would  result 
in  a  grasp  which  maximizes  the  combination  of  grasp  efficiency  (and  thus,  torquing 
capability)  and  robustness.  The  constraint  mapping  method  described  in  the  previous 
paragraph  can  also  be  used  for  this  case  .study. 
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Appendix  A.  Constraini  Map  Set  ti2 


A-1 


Figure  A-1.  Retracted  utral-Eias  Grasp.  <t>^  =  50® 
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Figure  A-2.  Retracted  Neutral-Bias  C'^asp,  =  0® 
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Appendix  B.  Constraint  Map  Set  #5 


B-1 


Figure  B-1.  Extended  Neutral-Bias  Grasp,  d>b  =  50° 


Figure  B-3.  Extended  Neutral-Bias  Grasp,  =  15 
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Figure  B-4.  Extended  Neutral-Bias  Grasp,  4)^  =  0 


Figure  B-5.  Extended  Neutral-Bias  Grasp,  =  -15 
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Appendix  C. 


Constraint  Mao  Set  tt4 
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Figure  C*l.  Intermediate  Thumb-Bias  Grasp,  =  50 
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figure  C-2.  Intermediate  Thumb-Bias  Grasp,  -  30 


Figure  C-3.  Intermediate  Thumb-Bias  Grasp,  =  15 


Figure  C-4.  Intermediate  Thumb-hia:  Grasp,  \  =  0“ 
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Figure  C-5,  Intermediate  Thumb-B’as  Grasp,  (t>^^  =  -15“ 
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Figure  C-6.  mediate  Thumb-Bias  Grasp,  0^,  =•  -30“ 
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Figure  C-7.  Intermediate  Thumb-Bias  Grasp,  =  -40 
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Figure  C*8.  Intermediate  Thumb-Bias  Grasp,  0^  -  -50 
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Figure  D-1.  Intermediate  Finger-Bias  Grasp,  =  50® 


Figure  D'2.  Intermediate  Finger-Bias  Grasp,  dij,  =  30“ 
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Figure  D-5.  Intermediate  Finger-Bias  Grasp,  <?[,  =  -15" 


Figure  D-6.  Intermediate  Finger-Bias  Grasp,  (p^  =  -30° 
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Figure  D-7.  Intermediate  Finger-Bias  Grasp,  =  -40 
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Figure  D-8.  intermediate  Finger-Bias  Grasp.  d>t,  =  -50‘ 
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Appendix  E.  Constraint  Map  Set  fid 


Figure  E-1.  Intermediate  Finger-Bias  Grasp  (Max.  Bias),  =  50 


Figure  E-2.  Intermediate  Finger-Bias  Grasp  (Max.  Biac),  <A 


Figure  E*3.  Ir.’crmediate  Finger-Bias  Grasp  (Max.  Bias),  0^  =  IP 
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Figure  E-5.  Intermediate  Finger-Bias  Grasp  (Max.  Bias),  =  -15 


Figure  E-6.  Intermediate  Finger-Bias  Grasp  (Max.  Bias), 


Figure  E*7.  Intel  mediate  Finger-Bias  Grasp  (Max.  Bias),  <^>^5  =  -40° 
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Appendix  F.  Inverse  Kinematics  Computer  Program 


a 


f 


non 


i 


Inverse  Kinematics  Fortran  Program  I 

Character  Yes*l,SYes*l,Ans*l 
Integer  K,N 

Real  Alpha,D3,D4,Ll,L2,L 3,Lo,Ln,RotInc,PsiO,Psil.Psi2. 
It  P3PsiO.PBPsil,PBPs.'2.PbiB 


a 

» 

» 


Double  Precision  XOC 1  .Y OC ! .ZOC  1,X!C1,Y1C1,Z1C1  ,X2C I , Y2C 1  ,Z2C  1 , 
XOC3.YOC3.ZOC3.XiC3.YlC3.ZlC3,X2C3,Y2C3,Z2C3. 
X0C2,Y0C2,Z0C2,X1C2.Y1C2,Z1C2.X2C2,Y2C2.Z2C2. 
TOO.'n0,T2O,TOl,T!l,T21,TO2,T12,T22,Deg,BBO, 

BB1,BB2 


Type  * 
Type  * 
Type  * 
Type  * 
Type  * 
Type  * 
Type  * 
Type  * 
Type 
Type  • 
Type  * 
Type  * 
Type  * 
Type  * 
Type  * 
Type  * 


*  Inverse  Kinematics  Program 

*•  for  an 

*  End  Grasp  of  a  Cylinder 

using  the 

*  UMDH  Point  Contact  Model 

* 


CCCCCCCCCCCCCCCCCCCCCCCC 


Establish  Constant  Values 

CCCCCCCCCCCCCCCCCCCCCCCC 

Rpb  =  0.6'^5 
R  =  1.08P2806 
LI  =  1.7 
L2  =  1,3 
L3  =  0  .735 
Lo  =  1 .2 
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Lp  =  1.05 
RpO  =  0,695 
Rpi  =  0.0 
Rp2  =  1.39 

Deg  =  3.141592654/180.0 

Pp  -=  12.0*Deg 

?o  =  30*Dsg 

Kp  =  0.95 

Ho  =  0.4 

Warn=0.0 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Use  Open  Statements  to  assooia'e  filenames 
C  with  various  logical  unit  numbers 
C 

cccccccccccccccccccccccccccccccccccccc 

Open(12,File  =  ’FingO.DAT',.Staius  =  ’Old’, 

#  Access  = ’Sequential’.  Form- ’Formated’) 

Open(13,Fi!e=  Fingl  DAT’,Status  =  ’01d‘, 

H  Access= 'Sequential’,  Form  = ’Formated’) 

Operi(  14, File  =  'Fing2,  DAT’.  513105  = ’Old’. 

#  Access  =  ’Sequentiar,  Form  = ’Formated’) 

Open(  15, File  = ’D3Curve.DAT’, Status  = ’Old’, 

#  Access  = ’Sequential’,  Form  = ’Formated’) 

Open(  16, File  = ’Hand. dal’. Status  =  ’Old’, 

Acce.':s  = ’Sequential’.  Form  = ’Formated’) 

ccccccccccccccccccccccccccccccccccccccccc 

c 

C  Prompt  for  input  v,.  iables  PsiO,  Fsil,  and  Psi2 
C 

ccccccccccccccccccccccccccccccccccccccccc 

1  Type  ’ 

Type  *,’  ’ 

Type  *. ’Input  F'siO  (Fing  0),  Psil  (Fing  1),  P5i2 
#(Fing  2)  (Deg);’ 

Accept  *,  PsiO.Psil  .Psi2 
Write(’‘,3)Psi0.Psi  1  ,Psi2 

3  Fofmat(/’PsiO  =  ’.F9.4,’  Psil  =’,F9.4,’  Psi2  =  ’,F9.4) 
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ccccccccccccccccccccccccccccccc 

c 

C  Prompt  for  Body  Rotation  Increment  (deg) 

C 

ccccccccccccccccccccccccccccccc 

Type  ' 

Type  ■ 

Type  *, 'Input  Body  RotaMon  Increment  (Pos  #  deg)' 

Accept  *.  Rotinc 
Write  (*.4)  Rotinc 

4  Format(/'Rotlnc  (Deg)  =',F7.4) 

cccccccccccccccccccccccccccccccc 

c 

C  Prompt  for  input  variables  Alpha,  D3.  and  D4 
C 

cccccccccccccccccccccccccccccccc 

Type  ’ 

Type  ' 

*  Type  *, 'Input  Alpha  (Deg).  D3  (Pos  tt  ir.chcs),  D4  (Pos  It 

*  M  inches);’ 

Type  •, 'Input  D3  and  D4  (inches)’ 

*  Accept  *,  Alpha, D3,D4 
Accept  *,03,04 
AIpha=-24.07773221758005 
Writc(*,5)Alpha,D3,D4 

5  Format(/’Alpha  (Deg)  =’.F9.4.’  D3  =  ’.F9.4,'  D4  =  ’.F9.4) 
DAlpha  =  Alpha 

Alpha  =  Alpha'Deg 

Type  *,’  ’ 

Type  ' 

Type  *, 'Input  Discrete  Body  Rotation  Angle  (Deg)  at’ 

Type  *,’wiiich  to  Output  Data  to  Hand.dat  File’ 

Accept  *,DiscPhi 
Write(*',7)DiscPhi 

7  FormatCDi.'.crete  Phi  Body  (Deg)  -  ’,F9.4) 


6  Type*.’ 

Type  *,’  ' 

Type  *, 'Beginning  Program’ 
Wr  ite(*,3)PsiO.Psi  1  ,P.si2 
Write;*, 4)RotInc 
Write(*.8)Alpha,D3.D4 
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Write(12.8)Alpha,D3,D4 

Write(13,8)Alpha,D3.D4 

Write(14,8)Alpha,D3,D4 

8  Format(/’Alpha  (Rad)  =’.F9.4.’  D3  =  *.F9.4.'  D4  =  \F9.4///) 

If  (Rotinc  .EQ,  0.0)  Then 
K=0 

Else 

K=170.0/Potlnc 

Endlf 


N=1 

PhiB  =  0.0 

Q  =  0 


cccccccccccccccccccccccccccccccccccc 

c 

C  Begin  Loop  to  Determine  Max  Body  Rotation  Angle, 

C  Given  a  Fixed  Value  for  D3  and  D4 
C 

C  First  Pass  (N  =  1)  Determines  Max  Left  (CCW) 

C  Rotation  Angle 
C 

C  Second  Pas.s  (N  =  -l)  Determines  Max  .flight  (CW) 

C  Rotation  Angle 
C 

cccccccccccccccccccccccccccccccccccc 

10  Do400i  =  0.K,N 

cccccccccccccccccccccccccccccccccccccccccccccccc 

c 

C  Convert  Angles  (PsiO.Psil  ,Psi2)  to  Radians  and  Define  Their 
C  Respective  Surrs  as: 

C 

C  PBPsi(j)  =  PhiB’Deg  +  Psi(j)*Deg,  where  j=  1,2,3 
C 

cccccccccccccccccccccccccccccccccccccccccccccccc 

PBPsiO  =  PhiB*Deg  +  P.siO'Deg 
PBP.sil  =  PhiB*Deg  +  Psil*Deg 
PBPsi2  =  PhiB*Deg  +  Psi2*Deg 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Calculate  contact  position  w.r  t  Palm  Frame 


C  (XOCi.YOCi.ZOCi),  where  i  =  1 .2.3 
C 

ccccccccccccccccccccccccccccccccccc 

XOCl  =  Cos(Alpha)*(D3  -  R*Sin(PBPsiO))  -  D4*Sin(Alpha) 
YOCl  =  Rpb  -  R*Cos(PBPsiO) 

ZOCl  =  D4*Cos(Alpha)  +  Sin(Alpha)*(D3  -  R*Sin(PBPsiO)) 

XOC2  =  Cos(Alpha)*(D3  -  R*Sin(PBPsil))  -  D4*Sin(Alpha) 
VOC2  =  Rpb  -  R*Cos(PBPsil) 

ZOC2  =  D4«Cos(Alpha)  +  Sin(Alpha)*(D3  -  R*Sin(PBPsil)) 

XOC3  =  Cos(Alpha)*(D3  -  R*Sin{PBPsi2))  -  D4*Sin(Alpha) 
YOC3  =  Rpb  -  R*Cos(PBPsi2) 

ZOC3  =  D4»Cos(Alpha)  +  Sin(Alpha)*(D3  -  R*Sin(PBPsi2)) 

cccccccccccccccccccccccccccccccccccc 

c 

C  Calculate  Finger  i  contact  position  w.r.t 

C  its*  Frame  1  .  (XlCi,  YlCi.  ZlCi).  where  i=  1.2.3 

C 

cccccccccccccccccccccccccccccccccccc 

XlCl  =  ZOCl 
YlCl  =  RpO  -  YOCI 
ZlCl  =  XOCl 

•  Write(*,15)XlCl.YlCl.ZlCl 

•15  Format(’XlCl=’,F7.4,3X.’YlCl  =  ’.F7.4.3X,*ZlCl=’,F7.4) 
X1C2  =  -Rpl  +  YOC2 

Y1C2  =  Hp»Cos(Pp)  +  Z0C2*Cos(Pp)  +  X0C2*Sin(Pp) - 
tt  Lp*Cos(Pp)*Tan(Pp) 

Z1C2  =  X0C2*Cos(Pp)  -  Hp*Sin(Pp)  -  ZOC2*Sin(Pp)  + 
it  Lp*Sin(Pp)*Tan(Pp) 

•  WriteC.16)XlC2.YlC2.ZlC2 

•16  Format(’XlC2  =  '.3X.F7.4.3X.’YlC2  =  ’.F7.4.3X,’ZlC2  =  ’,F7. 


X1C3  =  -kp2  +  YOC3 


Y1C3  =  Hp*Cos(Pp)  +  Z0C3*Cos(Pp)  +  X0C3*Sin(Pp) - 
tt  Lp*Cos(Pp)*Tan(Pp) 


Z1C3  =  X0C3*Cos(Pp)  -  Hp*Sin(Pp)  -  Z0C3‘Sin(Pp)  + 

#  Lp*Sin(Pp)*Tan(Pp) 

*  Write(*,17)XlC3,YlC3,ZlC3 

*17  ForniatCXlC3  =  ’,F7.4,3X,’YlC3  =  ’,F7.4.3X.’ZlC3  =  ',F7.4) 
CCCCCCCCCCCCCCCCCCCCCCCC 

c 

C  Calculate  Theta  Oi  (TOi) 

C  where  i=  1,2,3 

C 

CCCCCCCCCCCCCCCCCCCCCCCC 


If(XlCl  .EQ.  0.0)  Then 
T00  =  90*Deg 

Else 

TOO  =  DATan(YlCl/XlCl) 

EndlF 


If(XlC2  .EQ.  0.0)  Then 
T01=90*Deg 

ElseIF(XlC2  .LT.  0.0)  Then 

TOI  =  180*  Deg  +  DATan{YlC2/XlC2) 

Else 

TOI  =  DATan(YlC2/XlC2) 

EndlF 

If(XIC3  .EQ.  0.0)  Then 
T02  =  90*Deg 

ElseIF(XlC3  .LT.  0.0)  Then 

T02  =  180*  Deg  +  DATan(YlC3/XlC3) 

Else 

T02  =  DATan(YlC3/XlC3) 

EndlF 


CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Step  3:  Calculate  Finger  i  contact  position  w.r.t 
C  its’  Frame  2  (X2Ci,  Y2Ci,  Z2Ci),  where  i=  1,2,3 
C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

X2C1  =  -Ho  +  XlCl*Cos(T00)  YICl ‘SinfrOO) 

Y2C1  =  -ZICI 

Z2CI  =  YlCl*Co.s(T00}  -  XlCl*Sin(TOO) 
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X2C2  =  XiC?.*Cgs(T01)  -  Lo*Sin(Po)  +  YlC2*Sin(T01) 

Y2C2  =  -Z1C2  +  Lo*Cos(Po)  +  Lp/Cos(Pp) 

Z2C2  =  YlC2*Cos(T01)  -  XlC2*Sin(T01) 

X2C3  =  XlC3*Cos(T02)  -  Lo*Sin(Po)  +  YlC3*Sin(T02) 

Y2C3  =  -Z1C3  +  Lo*Cos(Po)  +  Lp/Cos(Pp) 

Z2C3  =  YlC3*Cos(T02)  -  XlC3*Sin(T02) 

ccccccccccccccccccccccccccccccccccccccccc 

c 

C  Determine  it  Contact  1  location  is  a  reachable  point 
C  (RMax  based  on  T20  =  T30  =  -6.5  degrees 
C  RMin  based  on  T20  =  T30  =  -90  degrees) 

C 

ccccccccccccccccccccccccccccccccccccccccc 

RMax0  =  3. 72095 1385087795 
RMinO=  1.619019765166565 
CDist0  =  Sqrt(X2Cl**2  -l-  Y2C1**2) 

If(CDistO  .LT.  RMinO)  Then 

Type  *, ’Contact  1  location  is  too  close  to  Finger  0  and’ 
Warn=l 

ElseIf(CDistO  .GT,  RMaxO)  Then 

Type  *,’Conatct  1  location  is  too  far  from  Finger  0  and’ 
Warn=  1 

Endlf 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Determine  if  Contact  2  location  is  a  reachable  point 
C  (RMax  based  on  T2I  =  T31  =6.5  degrees 
C  RMin  based  on  T2I  =  T31  =  90  degrees; 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

RMaxl  =3.720951385087795 
RMinl  =  1.619019765166565 
CDistl=Sqn(X2C2**2  +  Y2C2**2) 

lf(CDistl  .LT.  RMinl)Tlien 

Type  *, ’Contact  2  location  is  too  close  to  Finger  1  and' 
Warn=l 

Elself(CDisll  GT.  RMaxl)  Then 

Type  ’‘.'Conatct  2  location  is  u.o  far  from  Finger  1  and’ 
Warn=l 

Endlf 
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ccccccccccccccccccccccccccccccccccccccccccc 

c 

C  Determine  if  Contact  3  location  is  a  reachable  point 
C  (RMax2  based  on  T22  =  T32  =  6.5  degrees 
C  RMin2  based  on  T22  =  T32  =  90  degrees) 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

RMax2  =  3 . 72095 1385087795 
RMin2=  1.619019765166565 
CDist2  =  Sqrt(X2C3**2  +  Y2C3**2) 

If(CDist2  .LT.  RMin2)  Then 
Warn=  1 

Type  *, ’Contact  3  location  is  too  close  to  Finger  2  and' 
ElseIf(CDist2  .GT.  RMax2)  Then 

Type  ‘.’Conatct  3  location  is  too  far  from  Finger  2  and’ 
Warn=  1 

Endlf 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  If  any  of  the  contacts  are  noi  reachable  given  a 
C  neutral  body  position  (zero  rotation),  then 
C  start  over  and  request  new  inputs 
C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

If{(Warn  .EQ.  1)  .AND.  (PhiB  EQ.  0.0))  Then 
Type  ’ 

Type  ’ 

Type  *, ’Input  parameters  are  invalid' 

Type  ’ 

Type  *, 'Starting  Over’ 

Warn  =  0.0 
Type  ’ 

Type  •.’Requesting  new  inputs’ 

Type  •,’  ’ 

Go  to  1 

Endlf 

CCCCCCCCCCCCC CCCCCCCCCC 
C 

C  Calculate  Theta  20  (T20) 

C 

C  Calculate  Theta  10  (TIO) 

C 
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ccccccccccccccccccccccc 

BBO  =  (-2*L2*(L1  +  LSVa^LS)  +  Sqrt(4*L2*-2*(Ll 

#  +  L3)**2/(L1**2*L3*»2)-  16*(L1»*2  +  L2**2 

#  -  2*L1*L3  +  L3*»2  -  X2C1**2  -  Y2C1**2)/(L1  •L3)))/8 

T20  =  DATan(-Sqn(Abs(l-BB0*»2j)/BB0) 

TIO  =  DATan(Y2Cl/X2Cl)  -  DATan((L2*Sin(T20)  + 
tf  L3*Sin(2*T20))/(Ll  +  L2*Cos(T20)  +  L3*Cos(2*T20))) 


CCCCCCCCCCCCCCCCCCCCCCC 

c 

C  Calculate  Theta  21  (T2 1 ) 

C 

C  Calculate  Theta  11  (Til) 

C 

CCCCCCCCCCCCCCCCCCCCCCC 

BBl  =  (-2*L2*(L1  +  L3)/(L1*L3)  +  Sqrt{4*L2*»2*(Ll 
#  +  L3)**2/(L1*‘2‘L3**2)-  16‘(L1**2  +  L2**2 

M  ■  2*L1*L3  +  L3**2  -  X2C2**2  -  Y2C2*»2)/(L1  *L3)))/8 

T21  =  DATan(Sqn(ABS(l*BBl»*2))/BBl) 


T1 1  =  DATan(Y2C2/X2C2)  -  DATan((L2*Sin(T21)  + 
tt  L3*Sin(2*T21))/(Ll  +  L2*Cos(T21)  +  L3*Cos{2*r^  1))) 


CCCCCCCCCCCCCCCCCCCCCC 

c 

C  Calculate  Theta  22  (T22) 

C 

C  Calculate  Theta  12  (TI2) 

C 

CCCCCCCCCCCCCCCCCCCCCC 

BB2  =  (-2*L2*(L1  +  L3)/{LI*L3)  +  Sqrt(4*L2**2*(L! 

-r  L3)**2/(L1**2*L3**2)-  16*(L1*‘‘2  +  L2**2 
»  -  2*L1*L3  +  L3**2  -  X2C3**2  -  Y2C3**2)/(L1  *L3)))/8 

T22  =  DATan(Sqrl(Ab.s(  1-BB2**2))/BB2) 

TI2  =  DATan(Y2C3/X2C3)  -  DATan((L2*Sin(T22)  + 
f,  L3*Sin(2*T22))/(Ll  +  L2*Cas(T22)  +  L3*Cos(2*T22))) 
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ccccccccccccccccccccccc 

c 

C  Convert  angles  to  Degrees 

C 

CCCCCCCCCCCCCCCCCCCCCCC 

PBPsiO  =  PBPsiO/Deg 
PBPsi  1  =  PBPsi  I  /Deg 
PBPsi2  =  PBPsi2/Deg 
T00=T00/Deg 
T10=T10/Deg 
T20=T20/Deg 
T01=T01/Deg 
T11=T1 1/Deg 
T21=T21/Deg 
T02--T02/Deg 
T12  =  T12/Deg 
T22=T22/Deg 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

c 

C  Check  for  Joint  Angle  Limit  Violations 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

IF(Abs(T00)  .GT.  45)  Then 

Type  ‘/TOO  Exceeds  Limit’ 

Warn=  1 

ElseIf((TIO  .LT.-60,0)  OR.  (TIO  .GT.  15))  Then 
Type  ’TIO  Exceeds  Limit’ 

Warn-  1 

ElseIf((T20  .LT.  -90)  .OR.  (T20  .GT,  -6.5))  Then 
Type  •,’T20  Exceeds  Limit’ 

Warn=  1 

ElseIF((T0l  .GT.  115)  .OR.  (TOI  .LT.  65))  Then 
Type*,’T01  Exceeds  Limit’ 

Warn=  1 

Elself((Tll  .GT.  11)  .OR.  (Til  .LT.  -60))  Then 
Type  *,  'Til  Exceeds  Limit’ 

Warn=  1 

Elself((T2l  GT.  90)  .OR.  (T21  .LT.  3.5))  Then 
Type  *,  ’T21  Exceeds  Limi’ 

ElseIF((T02  .GT.  115)  .OR,  (T02  LT.  65))  Then 
Type*,*T02  Exceeds  Limit’ 

Warn=  1 
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Elself(m2  .GT.  11)  .OR.  (T12  .LT.  -60))  Then 
Type  *,  ’T12  Exceeds  Limit’ 

Warn=  1 

EiseIf((T22  .GT.  90)  OR.  (Ul  LT.  3  5))  Then 
Type  *,  ’T22  Exceeds  Limit’ 

Wcrn=l 

EndlF 

If((V'arn  .EQ.  1)  .AND.  (PhiB  .EQ.  0.0))  Then 
Type  ’ 

Type  ' 

Type  *  ’Input  parameters  are  invalid’ 

Write(*,22)  TO0,TlO.mTOl,TIl,T2l.T02.T12,T22 
Write(M9)  X2C1,Y2C1.X2C2.Y2C2,X2C3.Y2C3 
Type  • 

Type  *, 'Starting  Over’ 

Warn  =  0.0 
Type  ’ 

Type  ’‘/Requesting  new  inputs' 

Type  ' 

Go  to  1 

ElselFirvVarn  .EQ.  1)  .AND.  (N  .EQ.  -l))Then 
Type  ’*/at  end  of  right  rotation' 

Write(*,22)  T00.T10,T20.T0I.T1 1,T21,T02.T12.T22 
Write(M9)  X2C1.Y2C1.X2C2,Y2C2,X2C:.,Y2C3 
Write(*.20)RRMax 

Write(12.22)  T00,T10,T20,T01  .TI 1  ,T2 1,T02.T12,T22 

Write(  12. 19)  X2C 1 . Y2C 1  ,X2C2, Y2C2,X2C3, Y2C3 

Write(  13,22)  T0O,TlO,T2O,TOl  ,T1 1  ,T2 1  ,T02,T12,T22 

Write(13,19)  X2C1,Y2C1,X2C2,Y2C2,X2C3,Y2C3 

Write(  14,22)  T00.TiO.T20.TOl  ,T1 1  ,T2 1  ,T02,T12.T22 

Write(l4.19)  X2C1  .Y2C1.X2C2.Y2C2,X2C3,Y2C3 

Write(12.20)RRMax 

Write(13.20)RRMax 

Write(14.20)RRMax 

Go  to  500 

ElseIt((Warn  .EQ.  1)  .AND.  (N  .EQ.  I))  Then 
Type  ’*,'at  end  of  leh  rotation' 

Write(*.22)  TO0,TIO.T2O.TOl.Tll,T21.TO2.T12.T22 
Write{M9)  X2C..Y2C1,X2C2.Y2C2.X2C3,Y2C3 
Write(*.2l)RLMcK 

VVriie(12.22i  TOO.T10.T20.T01.T11,T21.T02.T12,T22 
Write(12,lv;  X2Cl.Y2Cl,X2C2.Y:C2.X2r3.Y2C3 
Write(13,22)  TOO.T10.T20,T01.T1  l.T21,T02.T12.T22 
Write(13.19)  X2C1.Y2C1.X2C2.Y2C'2.X2C3.Y2C3 
Write(  14.22)  TOO.T  I0,T20.T0I  .Tl  1  ,T2  1  .T02,T12,''  22 
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■vVrite(l4.19)  X2C1.Y2C1,X2C2.Y2C2.X2C3,Y2C3 

Write(12,21)RLMax 

Write(13.21)RLMax 

Wrlte(14,21)RLMax 

Go  to  450 

EndJf 

19  Format(/’Frame  2  Contact  Positions  at  Point  of  Violation  are;  ’ 
n  //’{X2Ci,Y2Ci,  =>  ’.2(‘{\F7.4,’,’.F7.4.’};  ■).’{’.-F7.4.’,’ 

n  ,F7.4,’}7) 

20  FormatCMax  Safo^  Right  Rt-tation  is  ’.F7.2,  ’  Degrees’//) 

21  FormatCMax  Safe  Left  Rotation  is  ’,F7.2,  ’  Degrees’//) 

22  Format(/’Joint  Angles  at  Point  of  Violation  are; 

#  /3(r8.3,3X),/3(F8.3,3X),/3(F8.3.3X)) 


ccccccccccccccccccccccccccccccccccccc 

Write  Finger  Data  to  the  Respective  Data  File 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

Write(12.30)  PhiB.XlCl . Y ICl ,Z1C1  ,PBPsi0.T0O,T10.T2O 
Write(13.30)  PhiB,XlC2,YlC2,ZlC2.PBPsil,T01.Tl  1,T21 
Wiite(i4.30)  PhiB.XlC3,YlC3,ZlC3,PBPsi2,T02,T12,T22 

If((PhiB  .EQ.  DiscPhi)  .AND.  Q  .EQ.  0)  Then 
Write(16,31)DAIpha 
Write(16.3:)R 
Write(U),3l)Rpb 
Wiite(16.3l)D3 
Write(16.3l)D4 
Write(16,3l)PhiB 
Write(16.3l)Psi0 
Write(16,31)Psil 
Write(16.31)Psi2 
Write(16,31)TOO 
Write(16.31)T10 
Write(16,31)T20 
Write(16,31)T01 
Write(16.3i)Tll 
Write(16.3!)T2l 
Write/ 16,3 1  )T02 
Wriie(16.31;T12 
Write/ 16,31)172 
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CntAngl  =  TIO  +  90  +  2*T20-DAlpha 
CntAng2  =  -(Tl  1  +  78  +  2*T21-DAIpha-180) 
CntAng3  =  -(T12  +  78  +  2*T22-DAIpha-180) 


AOO  =  TOO 
A10  =  T10 
A20  =  T20 
A01=T01 
A11=T11 
A21=T21 
A02  =  T02 
A12  =  T12 
A22  =  T22 


Q=1 

Endlf 


30  Format(4(F8.3,3X),/4(F8.3.3X)/) 

31  Format(F10.5) 

If  (N  .EQ.  1 )  Then 
RLMax  =  PhiB 

Else 

RRM^x  PhiB 

Endlf 

PhiB  ^  RotInc*N  +  PhiB 

400  Continue 

CCCCCCCCCCCCCCCC 

End  Do  Loop 

CCCCCCCCCCCCCCCC 

450  lf((N  .EQ.  1)  .AND.  (Rctinc  .GT.  0.))Then 
N  =  -l 
K  =  -K 
Warn  =  0.0 
PhiB  =  0.0 
Go  to  10 

Endlf 

500  RotMax  =  RLMax  -  RRMax 
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Type  ’ 

Type  *  ’*******••**♦♦***’' •*♦*’•'**»*-«*••*»•'**':«»*** ♦»** 

Write(*,505)RotMax 

Write(l2,505)RotMax 

Write(l3,505)RotMax 

Write(14,505)RotMax 

Type  ’'‘^’*****»**********  *•»»**».»?:»**  »»»«**»***»:**»* 

'J'ypg  *  ’*?"*«*««*»:«*»**«»> 

Type  *!’  ’ 

Type  ’ 

Type  • 

505  Format(/Total  Max  Safe  Rotaiiop  'S  ’,F6.2,  ’  Degrees’/) 


\Vrite(l5,520;D3,R.)tMax 
520  Format(F9.4,’,’F9.4; 


Write(*,54.5)CntAngl 
Type  ’ 

Write(*,550)CntAng2 
Type  ’ 

Write(*,555)CmApg3 
Type  ’ 

Type  ’ 

Write(*,22)  AOO,A10,A20,A01,A1 1,A2I.A02,A12,A22 
Type  ’ 

IF((CntAngl  .LT.  0)  .OR.  vCmAngl2  .LT.  0)  .OR. 

#  (CntAngl3  .LT.  0))  ITien 

Type  *,’Body  is  Too  Close  t  Hand’ 

Type  ’ 

Type  ’ 

Endlf 


Type*. ’Do  you  wish  to  start  over  with  a  new  \  a!ue  for 
D3  (Y/N)'’’' 

Read(5.530)Ans 
530  Format(A) 

Yes  =  ’Y' 

S’:'es  =  ’y’ 

IfUAns  F.Q.  Yes)  .GR.  (Ans  .EQ.  SYes))Then 
Type  ’ 

Type  *, 'Input  New  Value  for  D3’ 

Accept  *  .D3 
Type*,’ 

Write(*.540)D3 

540  Formatf’D.’  =  ’.F9.4) 
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\Van  =  0.0 
Go  to  6 


Endlf 

545  Furmat(lX, 'Contact  Angle  1  is  ’.FS.S) 
550  Format(lx, 'Contact  Angle  2  is  ’,F8.3) 
555  Format( lx, 'Contact  Angle  3  is  ',F8.3j 
Type*, 'Ending  Program' 

Type*,’  ’ 

Ciose(  12, Status  =  'Keep') 
Close(13,Status  =  ’Keep’) 

Close(  14, Status  =  'Keep'l 
Close(15,Status=  Keep’) 
Close(16,Status  =  ’Keep') 

Stop 

End 


I  16 


C  Program  Mapper 


CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

CC  This  Is  Mapper.  It  Is  A  Fortran  Program  That  Generates 

CC  Data  For  Constraint  Maps.  No  Subroutines  Arc  Called,  It 

CC  Just  Runs  Straight  Through. ..it  is  Explained  Well  With 

CC  Comments  Though,  So  I  Don't  Want  To  Hear  Any  Complaints 

CC  About  Not  Being  Able  To  Decipher  My  Code. 


CC 

CC 

Inputs; 

CC 

CC 

PsiO,Psil,Psi2. 

. Contact  Point  Locations  From 

CC 

Vertical.  Going  Clkwse 

CC 

CC 

Mz . 

..  External  Moment  Applied 

CC 

CC 

Mg . 

....Grasp  Force  Magnitude 

CC 

CC 

R . 

...Cylinder  Radius 

CC 

CC 

Mu . 

..  .Friction  Coefficient  (static 

CC 

CC 

S . 

..Scale  Of  Map  (  Number  Of 

CC 

Cylinder  Radii  from  the  Center 

CC 

to  the  Edge  of  the  Map) 

CC 

CC 

Run . 

....A  Two  Digit  Character  String 

CC 

Used  to  I  d.  Generated  Files 

CC 

CC 

ResX.ResY . 

. Map  Re.solution  (horiz  &  vert) 

CC 

Whole  Number  Representing  the 

CC 

Number  of  Pixels  per  X-Scale 

CC 

&  Y-Scale  of  Map 

CC 

CC 

Inputs  From  Hand.dat: 

CC 

CC 

L1,L2 . 

. 1st  And  2nd  Finger  L-'ngths 

CC 

CC 

Thetal  ,2,3 . 

. D&H  Link  Position  Angles 

CC 

CC 

Output  Files: 

(##  =  Run  Number) 

CC 

CC 

Stable##. dat.... 

. Data  Points  Indicating  Areas 

CC 

CC 

With  A  Stable  Code  (111) 

CC 

CC 

Bi,dry##.dat.... 

. Data  Points  For  Boundaries 

CC 

Between  Different  Code  Areas 

G-2 


cc 

cc 

Cntctsi<t#.dai... 

. Data  Points  For  Locations  Of 

cc 

Contact  Points 

cc 

cc 

Torq(ji).dat..., 

. Points  Where  Join:  Torque  (i) 

cc 

Limits  Are  Exceeded  for 

cc 

Finger  (j);  i  =  0.1,2,3  j  =  0,l,2 

cc 

cc 

SAS^I'^.dat . 

. Safe  And  Stable  Areas 

cc 

ccccccccccccccccccccccccccccccccccccccccccccccccccccccc 

Integer  Code, Code l.Code2.C(i(Je3,Codepr 
Real  Mu.Mg.Mz,Ll,L:,L3.Lu 

Double  Precision  P1.P2.P3.P4.P5.P6.P7.P8.P9,P10, 01.02.03.04.05, 
/l'06.R:.k2.R3.R4.R5.R6.Ul.U2.U3,U4,U5.U6.W:.W2.W3.W4.W5 
Character  Run’‘2, An.s*  1 , Yes*  1  ,S Yes*  1 

Type  *. 

Type  *, 

Type  *, 

Type  *. 

Type  *, 

Type  *, 

Type  *, 

Type  *, 

Type  •, 

Type  *, 

Type  *, 

Type  •, 

Type  *, 

Type  *. 

Type  *, 

Type  *, 

Type  *. 

Type  *, 

Type  *, 

Type  *, 

Type  *, 

Type  *, 

Type  *, 

Type  *, 

Type  *, 

Type  *, 

Type  *. 

cccccccccccccccccccrccc 

C 


«« 

««  «  «  ««  *«*«  «»««  »«*««»  »«»» 

««  **  mm  mm* 

m*  m  m  m  *  m  ******  «*  •*» 

******  «*««**  ****  ***«  *«*«  ««*«  »«* 

**  *  **  «*  *  «  ««  *«* 

*«  *  *»  *«  *  «  *«  *** 

**  *  *  *  *  *  *  **i'*«*  *  *  **• 

*«  *** 

***««*******#**■**«*«»:*  rc*^******************************** 
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C  Prompt  For  Various  Inputs 
C 

ccccccccccccccccccccccc 

Type  *, 'Input  External  Moment  Magnitude  (N-m);’ 

Accept  •,  Mz 
Write(*,5)Mz 

5  Format(F7.3,3X.F7.3//) 

Type  • 

Type  *, 'Input  Grasp  Force  Magnitude  (N);' 

Accept  *,  Mg 
Write(*,5)Mg 

Type  *, 'Input  Friction  Coefficient;' 

Accept  *,  Mu 
Write(*,5)Mu 
Type  ’.'Map  Scale  ?' 

Accept  *,  S 
Write(*,5)S 

Type  ‘.'Run  Number  ?  (2-digit)’ 

Read(5.10)Run 
Write(*,10'Riin 
10  Format(A) 

Type  *,'X-Resolution,Y-Resolution  (whole  numbers  >  1);' 

Type  ‘.'Note:  lising  Odd  Numbers  Will  Include  Cylinder  Center' 

Accept  •,  ResX.ResY 

Write(*,5)ResX.ResY 

Type  ‘.'Do  You  '»Vant  Extra  Boundary  Resolution  (Y/N)?' 
Read(5,20)Ans 
20  Format(A) 

Yes='Y’ 

SYes  =  'y' 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Use  Open  Statements  To  Associate  Filenames 
C  With  Various  Logical  Unit  Numbers 
C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

Open(12,File  =  'Hand.dat ’.Status  =  'Old' . 

1  Access  =  ’Sequeritiar, 

1  Form= 'Formatted') 

Open(13,File  =  ’TurqOO’//Run//’,dat’,Status  =  ’New', 

1  Access  = 'Sequential', 

1  Form  = 'Formatted') 
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Open(14,FiIe=TorqlO’//Run//’.ilat’,Status=’New’, 
1  Access  = ’Sequential’, 

1  Form  = ’Formatted’) 

Open(15,File  =  ’Torq20’//Run//’.dat’,Status  =  ’New’, 
I  Access  = ’Sequential’, 

I  Form  = ’Formatted’) 

C)pen(16,File=’Torq30’//Run//’.dat’,Status=  New’, 
1  Access  = ’Sequential’, 

1  Form  = ’Formatted’) 

Open(17,File=’TofqOr;7Run//’.dat’,Status=’New’, 
1  Access  = ’Sequential’, 

1  Form-- ’Formatted) 

Open(18,File=’Torql  r//Run//’.dat’,Status  =  ’New’, 
1  Access  = ’Sequential’, 

1  Form  = ’Formatted’) 

Open(  1 9,  File  = ’Torq21 ’//Run// ’.dat’, Status  = ’New’, 
1  Acce.ss  =  ’Sequentia!’, 

1  Form  = ’Formatted’) 

Open(20,File=’Torq3r//Run//’.dat’,Status  =  ’New’, 
1  Access  = ’Sequential', 

1  Form  = ’Formatted’) 

Open(2 1,  File= ’Torq02’//Run//’. dat’, Status  = ’New’. 
1  Access  = ’Sequential’, 

1  Form  =  ’Fornianed  ) 

Open(22. File  =  ’Torql2’//Run//’.dat’.Status  = ’New’, 
1  Access  = ’Sequential’, 

1  Form  = ’Formatted’) 

Open(23,File  =  ’Torq22’//Run//’.dai’,Status  =  ’New’. 
1  Access  =  ’Sequential’, 

1  Form  = ’Formatted’) 

Open(24,  File  =  ’Torq32 ’//Run//’,  dat’. Status  =  ’New’. 

1  Access  = 'Sequential', 

1  Form  = ’Formatted’) 

Open(25,  File  =  ’Stable’// Run.'/'. dat ’.Status  = ’New’, 

1  Access  =  ’Sequential’. 

1  Form  = ’Formatted’) 

Open(26,File  =  ’Bndry ’//Run/.' ’.dat ’.Status  = ’New’. 
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Access=  ’Sequential’, 
Form  = ’Formatted’) 


Open(27,File  = ’Cntcts//Run//’.dat’,Status  = ’New’, 

1  Access  = ’Sequential’, 

1  Form  = ’Formatted’) 

Open(28,File- ’SAS’//Run//'.dat’,Status  =  ’New*, 

1  Access = ’Sequential’, 

1  Form  =  ’ Formatted’) 

Open(29, File  =  ’StbBnd ’//Run//’. dat’, Status  = ’New’, 
1  Access  = ’Sequential’, 

1  Form  = ’Formatted’) 

Write(l3,235) 

VVrite(14,235j 

Wriie(l5,235) 

Write(l6,2J5) 

Write(17,235) 

Write(18.235) 

Writer  19.235) 

Write(20.235) 

Write(2 1,235) 

Write(22,235) 

Write(23,235) 

Write(24.235) 

Wiite(26.235) 

Write(27,235) 

Write(28.235) 

Write(29,235) 

cccccccccccccccccccccccccc 

Input  Data  From  Hand.dat  File 

CCCCCCCCCCCCCCCCCCCCCCCCCC 

Read(l2,30)Alpha 

Read(l2.30)R 

Read(l2.30)Rpb 

Read(12,30)D3 

Read(l2,30)D4 

Read(l2.30)PhiB 

Read(12,30)P;.i0 

Read(12,30)Psil 

Read(12.30)P.si2 

Read(  12.30)700 
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Read(12,30)T10 

Read(12.30)T20 

Read(12,30)T01 

Read(12,30)Tll 

Read(I2.30)T21 

Read(12,30)T02 

Read(12,30)T12 

Read()2,30)r22 


Write(*,3 1  )Alpha,R,Rpb 
WrueC.31)D3.D4,Phi'B 
WriteC  ,3  l)PsiO,Psi  •  .^'^'2 
Write(*,31)TOO.TlO.T20 
WriteC,31)T01,Tll.T2! 

WriteC.3l)T02,T:2.r22 

30  Format(F10.6) 

31  Format(/3(F10.5,3X)) 

cccccccccccccccccc 

c 

C  Convert  To  Meters 
C 

CCCCCCCCCCCCCCCCCC 

R  -  R  •  (0.0254) 

Rpb  =  Rpb  •  (0.0254) 

cccccccccccccccccccccccccccccccccccccc 

c 

C  Establish  Constant  Values  For  Hand  (Metric) 

C 

cccccccccccccccccccccccccccccccccccccc 

LI  =  1.7  •  (0.0254) 

L2  =  1.3  *  (0.0254) 

L3  =  0.735  *  (0,0254) 

Lo  =  1.2  *  (0.0254) 

Ho  =  0.4  *  (0.0254) 

Write(*,30)Ll,L2.L3.Lo,Ho 

Deg  =  3.141592654/180.0 
Pp  =  12.0*Deg 
Po  =  30*Deg 


TauOMX  -  2.958 
TaulMX  =  2.958 
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Tr.ulMX  =  1.139 
Tau3MX  -  .42' 

CCCCCCCCCCCCCCCCCCC 

C 

C  Convert  To  Radians 
C 

CCCCCCCCCCCCCCCCCCC 

Alpha  =  Alpha*Deg 
PhiB -PhiB*Deg 
PsiO=PsiO*Deg 
Psil  =  Psil*Deg 
Psi2  =  P>i2*Deg 
TOO = TOO  Deg 
T10=T10*Deg 
'n0=T20’Deg 
T01  =  T01*Deg 
T11=T1  l*Dej? 

T21=T21*Deg 

T02=T02*Deg 

T12=Tl2*Deg 

T22=T22*Deg 

ccccccccccccccccccccccccc 

c 

C  Set  Toggle  Switches  To  Zero 
C 

CCCCCCCCCCCCCCCCCCCCCCCCC 

ToglA0  =  0 
ToglB0=0 
ToglC0  =  0 
rogiDo=o 
ToglE0=0 
ToglF0=0 
ToglG0  =  0 
ToglH0  =  0 

ToglAl  =0 
ToglBl=0 
ToglCl--=0 
ToglDl  =0 
ToglEl=0 
ToglFl:=0 
ToglGl=0 
ToglHl=0 


ccccccccccccccccccccccccccccccccccccc 

Bl  =  Cos(Psil)-Cos(PsiO) 

B2  =  Cos(Psi !  )-Cos(Psi2) 

B3  =  Cos(Psi2  j-Cos(PsiO) 
C4=Sin(P.siO-Psi2)-Sin(PsiO-P.sil)-Sin(Psil-Psi2) 

B5  =  -Mz*Cos(Psil)/R 
B6=Mz*Cos(PsiO)/R 
B7  =  M2*Sin(PsiO-Psi  1  )/R 

XIE  =  B5/B1  •  (B2‘B7)/(BrB4) 

X2E  =  B6/B1  -  (B3*B7}/(B1*B4) 

X3E  =  B7/B4 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

c 

C  Calculate  Terms  Needed  For  Joint  Torque  Determination 
C 

cccccccccccccccccccccccccccccccccccccccccccc 

Dl0  =  L]*Cos(T10)  +  L2*CostT10  +  T20)  +  L3*Cos(T10  -r  2*T2C) 
D20  =  Ll*Sin(T10)  +  L2*Sin(T10  +  T20)  +  L3’Sin(TI0  ^  2*T20) 
D30  =  L2“Cos(T10  +  T20)  +  L3*Cus(T!0  +  2*T20) 

D40  =  L2*Siri(TI0  +  T20)  +  L3*Sin(T10  +  2*T20) 
D50=L3*Coi-(T10  +  2*T20) 

D60  =  L.3*Sin(T10  +  2*T20) 


D1 )  =L!*Cus(Tl  I)  +  L2*Cos(Tll  -!-  T2I)  +  L3*Co.s(Tl  1  +  2*T21) 
D21^Ll‘'Sm(Tl  1)  +  L2*Sin(Tll  -i-  T2I)  +  L3*Sin(Tll  +  2*T21) 
D31=L2»Cos(Tll  +  T2I)  +  L3*Cos(Tll  -h  2*T21) 

D4!  =L2*Sin(Tl  I  +  T21)  +  L3*Sin(Tl  I  +  2*T2I) 

D51=L3-Cos(Tl  1  +  2*T2I) 

D61^L3*Sin(TI  1  +  2*T2l) 
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Dl2  =  Ll*Cos(T12)  +  L2»Cos(T12  +  T22)  +  L3*Cos(T12  +  2*T22) 
D22-Ll*Sin(T12)  +  L2*Sin(Tl2  +  T22)  +  L3*Sin(Tl2  +  2*T22) 
D32  =  L2'Cos(T12  +  T22)  +  L3*Cos(ri2  +  2  *722) 

D42  =  L2'Sin(TI2  +  T22)  +  L3*Sin(T12  +  2*n2) 

D52  =  L3*‘Cos(T12  +  2*T22) 

D62  =  L3*Sin(T12  +  2*T22) 


ccccccccccccccccccccccccccccccccc 

c 

C  Calculate  Some  Needed  Trig  Terms  and 
C  Initialize  the  Comparison  Code  Term 
C 

ccccccccccccccccccccccccccccccccc 


Pl=-1.0*Cos(Psi0) 

P2  =  Sin(PsiO) 

P3  =  -1.0*Cos(Psil) 

P4  =  Sin(Psil) 

P5  =  -1.0*Cos(Psi2) 

P6=Sin(Psi2) 

Codepr  =  0.0 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Iteration  Loop  to  Calculate  Internal  Forces, 

C  Generate  Contact  Codes,  Calculate  Required 
C  Joint  Torques,  Etc. 

C  (One  Iteration  Per  Point  on  Grasp  Plane) 

C  ’••**»Stan  Here****** 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 


Type  *,  ’Beginning  Primary  Loop’ 

Type  *,  ’  ’ 

Do  150  V=i,0,ResY,I.C 

*  J  =  ResY-V+l 

*  Write(6,200)J 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Set  Flags  to  Determine  Boundries  of  Joim-T(»rque 
C  Limit  Exceedence  in  Stable  Map  (Code=  111) 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 


Flag00=  1 
FlaglO=  1 
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Flag20=  1 
Flag30=  1 

Flag01  =  l 
Flagll  =  l 
Flag21  =  1 
F)ag31  =  l 

Flag02=  1 
Flagl2=  1 
Flag22=l 
Flag32=--1 

FlgA00  =  0 
FlgBOO=l 

FlgA10  =  0 
FlgB10=  I 

FlgA20  =  0 
FlgB20=  1 

FlgA30  =  0 
FlgB30=l 

FlgAOl  =0 
FlgBOl  =  l 

FlgAll=0 
FlgBll  =  l 

FlgA21=0 
FlgB2l  =  l 

FlgA3l=0 
FlgB31  =  l 

FlgA02  =  0 
FlgB02=  1 

FlgA12  =  0 
FlgBI2=  I 

FlgA22  =  0 
FlgB22=  1 

FlgA32  =  0 
FlgB32=  1 
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Do  140  U  =  1.0,ResX.1.0 
Xg  =  ((U-1.0-ResX/2.0+0.5)*S*R)/(ResX/2.0-0.5) 
Yg  =  ((1.0-V  +  ResY/2.0-0.5)*S*R)/(ResY/2.0-0.5) 


P7  =  Xg*Sin(Psi  1  )-Yg*Cos(Psi  1 )+ R 
P8  =  Xg*Cos(Psil)  +  Yg*Sin(Psil) 
P9  =  Xg*Sin(Psi2)-Yg*Cos(Psi2)  +  R 
P10=Xg*Cos(Psi2)  +  Yg*Sin(Psi2) 


Q1=P3-P1 
Q2  =  P5-P1 

Q3  =  P4*P2  +  P1»P3-P2**2.0-P1**2.0 
Q4  =  P4*P1-P3*P2 

Q5  =  P6*P2  +  P 1  *P5-P2**2 .0-Pl  *•2.0 
Q6  =  P1*P6-P5»P2 

R1=P4*Q3-Q1*Q4 
R2  =  Q2*Q3-01*Q5 
R3  =  P6*Q3-QI*Q6 
R4  =  P8*Q3-P7*Q4 
R5  =  -1.0*Q5*P7 
R6  =  -1.0*Q6»P7 

U1=Q3»R4-Q5*R4  +  Q4‘R5 
U2  =  Q4*R6-Q6*R4 
U3  =  R2*R4-R1*R5 
U4  =  R3»R4-R!»R6 
U5  =  Q5»R4-Q4*R5 
U6  =  Q6*R4-Q4*R6 

V1=U1*P10-U2*P9 
V2  =  U3’P10-U4*P9 
V3  =  U5*P10-U6*P9 
V4  =  R5*P10-R6*P9 

W1=V1/(P9*03*R4) 

W2  =  V2/(P2*P9*03*R4) 

W3  =  V3/(P9*Q3*R4) 

W4  =  V4/(P9*R4) 

W5  =  -1.0*P10/P9 

Z3l  =  Mg/(Sqrt(\Vl**2  +  \V2**2)  +  Sqrt(\V3**2  +  W4**2)  +  ScinrvV5»*2+  1.0)) 

X11=W1*Z3I 

Z11  =  \V2*Z31 

X21  =  W3''Z3I 

Z21  =  W4*Z31 

X3I  =  W5*Z3I 
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ccccccccccccccccccccccccccccccccc 

c 

C  Calculate  Total  Contact  Forces  Needed 
C  at  Each  Ccntact  Point 
C 

cccccccccc:ccccccccccccccccccccccc 

X"r=XlE  +  X!i 
X2T=X2E  +  X2I 
X3T=X3E  +  X:iI 
Z  T  =  Z11 
Z2T=Z2I 
Z3T=Z3I 

cccccccccccccccccccccccccccc 

c 

C  Test  for  Constraint  Compliance 
C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCC 

Unstab=0,0 
If(ZlT  .LE.  0)  Then 
Codel  =3tK) 

Unstab  =  1 .0 

Else  If  (ABS(Xi  r)  .GE.  (ZlT*Mu))  Then 
Ccdel  =  20C; 

Else 

Codel  =  100 

End  It 

I.'tZ2T  .LE.  0;The.i 
Cocie2  =  3a 
Uns;ab=  1 .0 

Else  If  (AB.StX2T;  GE  (Z2T*Mu))  Then 
Ccde2  --20 
Else 

Code2=  iO 
Enc  If 

If  (Z3T  .LE,  0)  Then 
Code3  =  3 
Unstah-  1 .0 

ELse  lf(AES(X3T)  .GE.  (Z3T'Mu))  Then 
Codc3  =  2 
Else 

Code.!  =  1 

End  If 
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ccccccccccccccccccc 

c 

C  Calculate  Contact  Code 
C 

CCCCCCCCCCCCCCCCCCC 

Code = Code  1  +  Code2  -f  Code3 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

c 

C  Output  Coordinates  to  ’Stable^#. dat‘  if  the 
C  Contact  Code  =111. 

C 

C  TTiis  Group  of  points  respresents  the  Grasp 
C  Force  Focus  Map  if  Torque  Limitations  are 
C  not  Considered. 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

!!  (Code  .EQ.  llDTlien 
Write(25,220)Xg,Ys 
End  if 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Do  A  Left-to-right  Search  For  Code  Boundaries 
C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

If  (U  .EQ.  1.0)  Go  To  130 

If  ((Code  .EQ.  Ill)  .AND.  (Code-Codepr)  .NE.  0) 

K  Write(29,220)Xg.Yg 

If  ((Codepr  .EQ.  Ill)  .AND.  Codepr)  .NE.  0) 
it  Write(29,220)Xgpr,Yg 

If((Code-Codepr)  .NE.0)Then 
Xadj  =  Xg  -  R*S/Re.sX 
\Vrite(26,220)Xadj.Yg 
End  If 


CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Calculate  the  Joint  Torques  Required  to 
C  Exert  the  Forces  :(IT.Z1T.X2T.Z2T.X3T,Z3T 
C  on  the  Object.  Output  the  X  &  Y  Conids 
C  If  Joint  Torque  Limit.s  are  Exceeded. 

C 
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cccccccccccccccccccccccccccccccccccccc 


E10=-(ZlT*Cos(PhiB  +  PsiO))  -  XlT*Sin(PhiB  +  PsiO) 
E20=-(XlT*Cos(PhiB  +  PsiO)*Sin(Alpha;)  +  ZlT*Sin{Alpha)* 

K  Sin(PhiB  +  PsiO) 

E30=-(XlT*Cos(Alrna)*Cos(PhiB  4-  PsiO))  +  ZlT*Cos(Alpha)* 
if  Sin(PhiB  -f  PsiO) 

Ell=Z2T*Cos(PhiB  +  Psil)  +  X2T*Sin(PhiB  +  Psil) 
£21=-(X2T*Cos(PhiB  H  Psil)*Sin(Alpha  +  Pp))  + 
ft  Z2T*Sin(Alpha  +  Pp)*Sin(PhiB  +  Psil) 

E31=-(X2T*Cosf  Alpha  +  Pp)*Cos(PhiB  +  Psil))  + 
ft  Z2T*Cos(Alpha  +  Pp)*Sin(PhiB  +  Psil) 

E12  =  Z3T*Cos(PhiB  +  Psi2)  +  X3T*Sin(PhiB  +  Psi2) 

E22  =  -(X3T*Cos{PhiB  +  Psi2)*Sin(Aipha  +  Pp)>  + 
if  Z3T*SiiAAlpha  +  Pp)*Sin(PhiB  +  Psi2) 

E32  =  -(X3T*Cos(Alpha  +  Pp)»Cos{PhiB  Psi2))  + 
ft  Z3T*Cos(Alpha  +  Pp)*Sin''PhiB  +  Psi2) 

TauOO  =  Cos(TOO)*(Ho  DlO'^r-  '  -  (Ho  +  D10)*E20*Sin(T00) 

TaulO  =  -(D10“E30)  -  CosaiX,*^- J*D20  -  E10*Sin(T00)*D20 
Tau20  =  -(D30-E30)  -  Cosrr00l’E20*D40  -  ElO*Sin(T00)*D40 
Tau30  =  -(D50*E30)  -  Cus(T00)*E20*D60  -  E10*Sina00)*D60 

TauOl  =Cos(TOI)*(D!  1  +L()*Sin(Po))*E2l-(DI  1  +  Lo*Sin(Po))*El  l*Sin(T01) 
Taull  =  -(D11*E31)  -  Cos(T01)*Ell»D21  -  E21*Sin(T01)*D21 
Tau21  =  -(D31*E31)  -  Cos(T0l)*Ell*D41  -  E21*Sin(T01)*D41 
Tau31  =  -(D5rE3l)  -  Cos(T01)*Ell*D61  -  E2l*Sin(T01)*D61 

T3u02  =  Cos(TO?)*(D  1 2  +  Lo*Sin(Po))*E22-(D  1 2  +  Lo‘Sin(Po))‘E  1 2  *Sin(T02) 
Taul2  =  -(D12*E32)  -  Cos(T02)*EI2»D22  -  E22*Sin(T02)*D22 
Tau22  =  -(D32*H32)  -  Cos(T02)»E  12*042  -  E22*Siu(T02)*D42 
Tau32  -(052*E32)  -  Co.s(T02)*E  12*062  -  E22*Sin(T02)*Oo2 

C.  '^CCCCCCC  cccccccccccccccccccccccccccccccc 

Rese'  Toggles  Ij,  Jj,  Kj,  Lj  &  WW  to  zero 
where  j  =  0,  1,  2 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 


Togll0  =  0 
ToglJ0  =  0 
ToglK0  =  0 
ToglL0  =  0 

Toglll  =  0 
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ToglJl=0 

ToglKl=0 

ToglLl=0 

ToglI2-0 
ToglJ2  =  0 
ToglK2  =  0 
ToglL2  =  0 

ToglWW  =  0 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

Check  for  Torque  Limit  Exceedence  in  Total  Map  Area 
(Checks  All  Map  Points) 

ToglAj/Bj/Cj/Dj  =  1  indicates  that  the  Torque  Limit  was 
exceeded  for  some  point  ii.  the  Map  Area 

Note;  This  two  Toggle  Type  is  never  reset  to  zero 

cccccccccccccccccccccccccccccccccccccccccccccc 

If  (ABS(TauOO)  .GT.  TauOMX)  Then 
ToglA0=  1 
Endlf 

If  (ABS(TaulO)  .GT.  TaulMX)  Then 
ToglB0=l 
Endlf 

If  (ABS(Tau20)  .GT.  Tau2MX)  Then 
ToglC0=  1 
Endlf 

If  (ABS(Tau30)  .GT.  Tau3MX)  Then 
ToglDO^  1 
End  if 

if  (ABS(TauOl)  GT.  TauOMX)  I  hen 
ToglAI  =  l 
Endlf 

If  (ABS(Taul  I)  .GT,  TaulMX)  Then 
ToglBl  =  1 
Endlf 

If  (ABS(Tau2i)  .GT.  Tau2MX)  Then 
ToglCl  =  l 
Endlf 

If  (ABS(Tau3I)  .GT.  Tau3MX)  Then 
ToglDl  =  l 
Endif 
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If  (ABS(Tau02)  .GT.  TauOMX)  Then 
ToglA2=  1 
Endlf 

If  (ABS(Taul2)  .GT.  TaulMX)  Then 
ToglB2=l 
Endlf 

If  (ABS(Tau22)  .GT.  Tau2MX)  Then 
ToglC2=I 
Endlf 

If  (ABS(Tau32)  .GT.  Tau3MX)  Then 
ToglD2=l 
Endif 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

Check  for  Torque  Limit  exceedence  in  the  Stable  Map 
(Code  =  111)  Area 

ToglEj/Fj/Gj/Hj  =  1  indicates  that  the  Torque  Limit  wa.s 
exceeded  for  some  point  in  Stable  Map  (Code=  111) 

Note:  These  Toggle  Types  are  never  reset  to  zero 

Togllj/Jj/Kj/Lj  =  1  indicates  that  the  Torque  Limit  was 
exceeded  at  the  particular  Stable  Grasp  Focus  point  being 
analyzed  in  the  Stable  Map  Area 

Note:  These  Toggle  Types,  Along  with  ToglWW,  are  Reset  for 
Each  Iteration 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

If  ((ABS(TauOO)  .GT.  TauOMX)  .AND.  (Code.EQ.  11 1))  Then 
ToglE0=  1 
Tog  i  10=  I 
ToglWW=l 
Endlf 

If  ((ABSaaulO)  GT.  TaulMX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglF0=  1 
ToglJ0=l 
ToglWW  =1 
Endi: 

If  ((ABS(Tau20)  .GT.  Tau2MX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglG0=  1 
ToglK0=l 
ToglWW=l 
Endlf 

If  {(ABSnau30)  .GT.  Tau3MX)  .AND.  (Code  .EQ.  Ill))  Then 
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ToglHO=l 
ToglLO=l 
ToglWW  =  l 
End  if 

If  ((AESCTauOl)  .GT.  TauOMX)  .AND.  (Code  EQ.  Ill))  Then 
ToglEl-=l 
Toglll  =  l 
ToglWW=l 
End  If 

If  ((ABS(Taull)  .GT.  TaulMX)  .AND.  (Code  .EQ.  Ill))  Then 
Tog»Fl  =  l 
ToglJ  1  =  1 
ToglWW=l 
EncIIf 

If  ((ABS(Tau21)  .GT.  Tau2MX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglGl-1 
Tog!Kl  =  l 
ToglWW=l 
Endlf 

If  ((ABS(Tau31)  GT.  Tau3MX)  AND.  (Code  .EQ.  Ill))  Then 
ToglHl  =  l 
TogILl  =  I 
Togl\VW=  1 
End  if 

If  ((ABS(Tau02)  GT.  TauOMX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglE2  =  l 
ToglI2=l 
ToglWW=l 
Endlf 

If  ((ABS(Taul2)  GT.  TaulMX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglF2=l 
ToglJ2=l 
ToglWW=l 
Endlf 

If  ((ABS(Tau22)  .GT.  Tau2MX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglG2=l 
ToglK2=l 
ToglWW=l 
Endlf 

If  ((ABS(Tau32)  .GT.  Tau3MX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglH2=l 
TogIL2=l 
ToglWW-  1 
Endif 

CCCCCCCCCCCCCCCCCCCCCCCCCrCCCCCCCCCCCCCCCCCCCC 


G-18 


o  n  n  o  n 


Check  for  Torque  Limit  exceedence  in  the  Stable  Map  Area 
(For  All  Points  in  Are?;  Code=  111)  If  True,  Write  Grasp 
Focus  BOUNDRY  Point  to  the  Respective  Finger-Joint  File. 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCOCCCCC 

If  ((TogllO  .EQ.  1)  .AND.  ((FlagOO  -  FIgAOO)  .NE.  0))  Then 
Write(13,220)Xg,Yg 
FlagOO  =  0 
Endlf 

If  ((TogllO  .EQ.  Oj  .AND.  (Code  .EQ.  Ill)  .AND. 

I*  ((FlgBOO  -  FlagOO)  .NE.  0))  Then 
Write(l3,220)Xg,Yg 
FlagOO  =  1 
Fndlf 

If  (O'oglAO  .EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 

n  (Codepr  .EQ.  Ill)  .AND.  (FlagOO  .EQ.  0/)  Then 
Write(13,220)Xgpr,Yg 
FlagOO  =  1 
Endlf 

If  ((TogIJO  .EQ.  1)  .AND.  ((FlaglO  -  FlgAIO)  .NE.  0))  Then 
Write(14,220)Xg,Yg 
FlaglO  =  0 
Endlf 

If  ((TogIJO  .EQ.  C)  .AND.  (Code  .EQ.  Ill)  .AND. 

#  ((FIgBlO  -  FlaglO)  NE.  0))  Then 
Write(14.220)Xg,yg 
FlaglO  =  I 
Endlf 

If  ((ToglBO  .EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 

U  (Codepr  .EQ.  Ill)  .AND.  (FlaglO  EQ.  0))  Then 
Write(14,220)Xgpr,Yg 
FlaglO  -  1 
Endlf 

If  ((TogIKO  .EQ.  1)  .AND.  ((Flag2(;  -  FlgA:0)  .NE.  0),'  Then 
Write(15.220)Xg.Yg 
Flag20  ^  0 
Endlf 

If  ((TogIKO  .EQ.  0)  .AND  (Code  .EQ.  Ill)  .AND. 

U  ((FlgB20  -  Flag20)  .NE.  0))  Then 
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Write(15,220)Xg.Yg 
Flag20  =  I 
Endlf 


If((ToglCO  .EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 
ft  (Codepr  .EQ.  !il)  .AND.  (FlHg20  EQ.  0))  Then 
Wrije(15,220)Xgpr,Yg 
F!ag20  =  1 
Endlf 

If  ((TogILO  .EQ.  i:  .AND.  ((FlagSO  -  FlgA30)  .NE.  0))  Then 
Write(16.220)Xg,Yg 
FlagSO  =  0 
Endlf 

If  ((TogILO  .EQ.  0)  .AND.  (Code  EQ.  1 1 1>  .AND. 

#  ((FlgB30  -  Flag30)  .NE.  0);  Then 

Write(16.220)Xg,Yg 
Flag30  =  1 
Endlf 

If  ((TogIDO  EQ.  1)  AND  (Code  NE.  Ill)  .AND, 

#  (Codepr  .EQ.  1 1 1)  .AND.  (Flag30  .EQ,  0))  Then 

Write(16,220)Xopr.Yg 
Flag30  =  1 
Endlf 


If  ((Toglll  .EQ.  1)  .AND.  ((FlagCl  -  FIgAOl)  .NE.  0))  Tlien 
Write(17.220)Xg,Yg 
FlagOl  =  0 
Endlf 

If  ((Toglll  .EQ.  0)  AND.  (Code  .EQ.  Ill)  .AND. 
if  ((FlgBOl  -  FlagOl)  .NE.  0))  Then 
Write(17,220)Xg.Yg 
FlagOl  =  1 
Endlf 

If  ((ToglAl  .EQ.  1)  .AND.  (Code  ,NE.  Ill)  .AND. 

#  (Codepr  .EQ.  Ill)  .AND.  (FlagOl  EQ.  0))  Then 
Write(17,220jXgpr,Yg 
FlagOl  1 
Endlf 

If((TogIJI  ,EQ,  1)  .AND.  ((Flagll  -  FlgAll)  .NE.  0))  Then 
Write!  18,220)Xg,Yg 
Flagll  =  0 
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Endlf 


If  ((ToglJl  .EQ,  0)  .AND.  (Code  .EQ.  Ill)  .AND. 

#  ((FIgBl  1  -  Flagl  1)  .NE.  0))  Then 

Write(18,220)Xg,Yg 
Flagl 1  =  1 
Endlf 

if((ToglBl  EQ.  1)  AND  (Code  .NE.  Ill)  AND. 

#  (Codepr  .EQ.  111).  AND.  (Flagl  1  .EQ.  0))  Then 

Write(18,220)Xgpr,Yg 
Flagl 1  =  1 
Endlf 

If  ((ToglKl  EQ.  1)  AND.  ((Flag2l  -  FlgA21)  .NE.  0))  Then 
Write(19,220)Xg.Yg 
Flag21  =  0 
Endlf 

If  ((ToglKl  .EQ.  0)  .AND.  (Code  .EQ.  Ill)  .AND. 
n  ((FlgB21  -  Flag21)  .NE.  0))  Then 
Write(I9.220)Xg,Yg 
Flag21  =  1 
Endlf 

lf((ToglCl  .EQ.  1).AND.  (Code  .NE.  Ill)  .AND. 

#  (Codepr  .EQ.  Ill)  .AND.  (Flag2l  .EQ.  0))  Then 

Write(19,220)Xgpr,Yg 
Flag2l  =  1 
Endlf 

If  ((ToglLl  EQ.  1)  .AND.  ((Flag31  -  FlgA31)  .NE.  0))  Then 
Write(20,220)Xg,Yg 
Flags  1  =  0 
Endlf 

If  ((ToglLl  .EQ.  0)  AND  (Code  EQ  111)  .AND. 

#  ((FlgBSl  -  Flag31)  .NE.  0))  Then 

Write(20,220)Xg,Yg 
Flag3l  =  1 
Endlf 

lf((ToglDl  .EQ.  1).AND.  (Code  .NE.  Ill)  AND. 
n  (Codepr  .EQ.  Ill)  .AND.  (Flag3l  EQ.  0))  Then 
Write(20,220)Xgpr,Yg 
Flags  1  =  1 
Endlf 
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If  ((ToglI2  .EQ.  1)  .AND.  ((Flag02  -  FlgA02)  .NE.  0))  Then 
Write(21,220)Xg.Yg 
Flag02  =  0 
Endlf 

If  ((ToglI2  .EQ.  0)  .AND.  (Code  .EQ.  Ill)  .AND. 

M  ((FlgB02  -  Flag02)  NE.  0))  Then 
Write(21,220)Xg,Yg 
Flag02  =  1 
Endlf 

If  ((ToglA2  .EQ.  I)  .AND.  (Code  .NE.  Ill)  .AND. 

#  (Codepr  .EQ.  1 1 1)  .AND.  (Flag02  .EQ.  0))  Then 
Write(2 1 ,220)Xgpr,  Yg 
Flag02  =  1 
Endlf 

If((ToglJ2  .EQ.  n  .AND.  ((Flagl2  -  FlgA12)  .NE.  0))  Then 
Write(22,220)Xg.Yg 
Flag  12  =  0 
Endlf 

If  ((ToglJ2  .EQ.  0)  AND.  (Code  .EQ.  Ill)  .AND. 
it  ((FlgB12  -  Flagl2)  NE.  0))  Then 
Write(22.220)Xg.Yg 
Flag  12  =  1 
Endlf 

If  ((ToglB2  EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 

M  (Codepr  EQ.  Ill)  AND.  (Flagl2  .EQ.  0))  Then 
Write(22,220)Xgpr,Yg 
Flagl2  =  1 
Endlf 

If  nToglK2  .EQ.  1)  .AND.  ((Flag22  -  FlgA22)  .NE.  0))  Then 
Write(23,220)Xg,Yg 
Flag22  =  0 
Endlf 

If  ((TogiK2  .EQ.  C)  .AND.  (Code  .EQ.  111>  AND. 
it  ((FlgB:2  -  F!.;;:22;  NE.  0))  Then 
Write(23.220iXi,.Vg 
yiugll  =  1 
Endlf 

If  ((ToglC2  .EQ.  I)  .AND.  (Code  .NE.  Ill)  .AND. 
it  (Codepr  .EQ.  ill)  AND.  (Flag22  EQ  0)^  Then 
Write(23,220)Xgpr,Yg 
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Flag22  =  1 
Endlf 


If  ((ToglL2  .EQ.  1)  .AND.  ((Flag31  -  FlgA32)  .NE.  0))  Then 
Write(24,220)Xg,Yg 
Flag32  =  0 
Endlf 

If  ((ToglL2  .EQ.  0)  .AND.  (Code  .EQ.  Ill)  .AND. 
n  ((FlgB32  -  Flag32)  .NE.  0))  Then 
Write(24,220)Xg.Yg 
Flag32  =  1 
Endlf 

If  ((ToglD2  .EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 
n  (Codepr  .EQ.  Ill)  AND.  (Flag32  .EQ.  0))  Th.;n 
Write(24,220)Xgpr.Yg 
Flag32  =  1 
Endlf 


CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Output  Coordinates  To  ’SAS##.dat’  If 
C  the  Contact  Code  is  1 1 1  and  None  of 
C  Torque  Limits  are  Exceeded. 

C 

C  This  group  of  points  is  the  Net, 

C  Usable  Grasp  Force  Focus  Map. 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

If  ((Code  EQ.  Ill)  .AND.  CFoglWW  .EQ.  0))  Then 
ToglZZ=I 
Write(28.220)Xg.  Yg 


Endlf 


CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCrCCCC 

c 

C  Hgre****** 

C  Update  Codepr  And  Return  To  Beginning  Of  Loop 
C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 
130  Codepr  =  Code 
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Xgpr  =  Xg 
140  Continue 
150  Continue 


CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Now  Look  For  Horizontal  Boundary  Lines  That  Would  Not 
C  Show  Up  With  A  Left  To  Right  Type  Of  Search.  Write 
C  These  Boundary  Points  To  ’bndry##.dat’ 

C  ******Start  Here****** 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

If  ((Ans  -NE,  Yes)  .AND.  (Ans  .NE.  SYes))  Go  To  210 
Codepr  =  0 

Type  *,  'Beginning  Top-to-Bottom  Boundary  Search’ 

Type  *.  ’  ’ 

Do  180  U=1.0.ResX.I.0 

*  J  =  ResX-U+l 

•  Write(6,200)J 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Set  Flags  to  Determine  Boundries  of  Joint-Torque 
C  Limit  Exceedence  in  Stable  Map  (Code  =  1 1 1) 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

Flag00=l 
FlagI0=  1 
Flag20=l 
Flag30=  1 

FlagOl  =  1 
Flagll  =  l 
Flag21  =  l 
Flag3l  =  1 

Flag02=l 
Flagl2  =  l 
Flag22=l 
Flag32=l 

FlgA0O  =  0 
FlgBOO=  1 

FlgA10  =  0 
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FlgB10=l 

FlgA20=0 
FlgB20=  1 

FlgA30=0 
FlgB30=  1 


FlgA01=0 
FlgB01  =  l 

FlgAll=0 
FlgBll  =  l 

Fig  A2 1=0 
FlgB21  =  l 

FlgA31=0 
FlgB31  =  l 

FlgA02  =  0 
FlgB02=l 

FlgA12  =  0 
FlgB12=l 

FlgA22  =  0 
FlgB22=l 

FlgA32  =  0 
FlgB32=l 

Do  170  V=1.0.ResY,1.0 
Xg  =  ((U-1.0-ResX/2.0  +  0.5)*S*R)/(ResX/2.0-0.5) 
Yg  =  (( 1 .0- V  +  Res  Y/2.0-0.5)*S  »R)/(Res  Y/2.0-0.5) 

P7  =  Xg*Sin(P.sil)-Yg*Cos(Psil)  +  R 
P8  =  Xg*Cos(Psi  1 )  +  Yg*Sin(Psi  1 ) 

P9  =  Xg*Sin(Psi2)-Yg*Co.s(Psi2)  +  R 
P10  =  Xg*Co5(Psi2)-r  Yg*Sin(P.si2) 

Ol=P3-PI 
Q2  =  P5-P1 

Q3  =  P4*P2  +  P1*P3-P2**2.0-P1**2.0 
Q4  =  P4*PI-P3*P2 

05  =  P6*P2  +  PI  •P5-P2**2.0-P  1  •*'2.0 
Q6  =  P1*P6-P5*P2 
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noon 


ri  =  P4»Q3-Q1*Q4 
R2  =  Q2*Q3-Q1*Q5 
R3  =  P6*03-01*Q6 
R4  =  P8*03-P7*Q4 
R5  =  -1.0*O5*P7 
R6=-1,0*Q6*P7 


U 1  =  Q3*R4-Q5*R4  +  Q4*R5 
U2  =  Q4*R6-Q6*R4 
U3  =  R2*R4-R1*R5 
U4  =  R3*R4-R1*R6 
U5  =  Q5*R4-04*R5 
U6  =  Q6*R4-Q4*R6 

V1-U1*P10-U2*P9 
V2  =  U3*P10-U4*P9 
V3  =  U5*P10-U6*P9 
V4  =  R5*P10-R6*P9 

W1=V1/(P9*Q3*R4) 

W2  =  V2/(P2*P9*Q3*R4) 

W3  =  V3/(P9*Q3*R4) 

W4  =  V4/(P9*R4) 

W5  =  -1.0*P10/P9 

Z3I  =  ^'lg/(Sqrt(W  1  **2  +  \V2**2)  +  Sqrt(W3‘  “2  +  W4**2;  +  SquCWi* 

X11  =  W1*Z3I 

Z1I  =  W2»Z3I 

X2I  =  W3*Z31 

Z21  =  W4«Z3I 

X3I  =  V.'5*Z3I 

ccccccccccccccccccccccccccccccccccc 


Calculate  Total  Contact  Forces  Needed 
At  Each  Contact  Point 


CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

XIT-XIE  +  Xll 
X2T  =  X2E  +  X21 
X3T  =  X3E-i-X3I 
ZlT  =  Zil 
Z2T  =  Z2I 
Z3T=Z31 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 
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•2  +  1,0)) 


C  Test  For  Constraint  Compliance 
C 

cccccccccccccccccccccccccccccc 

If  (Z!T  .LE.  0)  Then 
Cede!  =300 

Else  If  (ABSaiT)  .GE.  (ZlT*Mu))  Then 
Code  1=200 

Else 

Ccdel  =  100 

End  If 

If  (Z2T  .LE.  G)  l.nen 
Code2-O0 

E:se  If  (.\BS{X2T)  GE  (Z2  I  ’Mii))  Then 
CtK;e2  =  20 

Else 

Code2^10 

End  It 

If  (Z3T  .LE.  0)  Then 
Codes  =  3 

Else  If  (ABS(X37)  .GE.  (Z3T'"Mu))  'Fhen 
Code3  =  2 

Else 

Code3=  1 

End  If 

CCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Calculate  Contact  Code 
C 

ccccccccr  C  CCCC  cccccccccc 

Code  =  Code  1  +  Coue2 +  Cv)de.3 


cccccccc:cccccc,ccccccccc:cccccccc 

c 

C  Do  A  Search  For  C  ode  E-oUMdar.-e;, 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

If  (V  LQ.  10)  Go  To  !(  .5 

It  ((Code  .E(d.  II 1)  .AM).  (Code-Codepr)  NE.  0) 
#  Write(29.2:0)XL-.Yg 
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If  ((Codepr  .EQ.  1 1 1)  .AND.  (Code-Codepr)  .NE.  0) 
#  Write(29,220)Xg,Ygpr 


If  ((Code-Codepr)  .NE.  0)  Then 
Yadj  =  Yg  -t-  R*S/ResY 
Write(26,220)Xg,Yadj 
Endif 

ccccccccccccccccccccccccccccccccccccc 

c 

C  Calculate  the  Joint  Torques  Required  to 
C  Exert  the  Forces  X1T,Z1T,X2T,Z2T,X3T.Z3T 
C  on  the  Object,  Output  the  X  &  Y  Coords 
C  If  Joint  Toique  Limits  are  Exceeded. 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

E10  =  -(ZlT*Cos(PhiB  +  PsiO))  -  XlT*Sin(PhiB  -i-  PsiO) 

E20  =  -(XlT’Cos(PhiB  -t-  PsiO)*Sin(Alpha))  +  ZlT*Sin(Alpha)* 

»  Sin(PhiB  -t-  PsiO) 

E30  =  -(XlT»Cos(Alpha)*Cos{PhiB  -t-  PsiO))  ZlT*Cos(Alpha)‘ 
»  Sin(PhiB  -I-  PsiO) 

Ell=Z2T*Cos(PhiB  -t-  Psil)  +  X2T*Sin(PhiB  +  Psil) 

E21  =-(X2T*Cos(PhiB  +  Psi  l)*Sin(Alpha  +  Pp))  + 

#  Z2T*Sin( Alpha  -f  Pp)*Sin(PhiB  +  Psil) 

E3l  =-(X2T*Cos(Alpha  +  Pp)*Cos(PhiB  +  Psil))  + 

#  Z2T*Cos(Alpha  -t-  Pp)*Sin(PhiB  +  Psil) 

E12  =  Z3T»Co.s(PhiB  -(-  Psi2)  +  X3T*Sin(PhiB  +  Psi2) 

E22  =  -(X3T*Cos(PhiB  +  Psi2)*Sin(Alpha  Pp))  -t- 
ff  Z3T*Sin(Alpha  +  Pp)»Sin(PhiB  +  Psi2) 

E32  =  -(X3T*Co.s(Alpha  +  Pp)*Cos(PhiB  +  Psi2))  + 

#  Z3T*Cos(Alpha  +  Pp)*Sin(PhiB  +  Psi2) 

TauOO  =  Cos(T00)*(Hu  +  D10)*EI0-(Ho  +  D10)*E2O*Sin(T00) 
TaulO  =  -(DI0*E30)  -  Cus(T00)»E20*D20  -  E10*Sin(T00)*D20 
Tau20  =  -(D30*E30)  -  Co.s(T00)*E20*D40  -  EI0*Sin(T00)*D40 
Tau30  =  -(D50*E30)  -  Cus(T00)*E20*D60  -  E10»Sin(T00)*D60 

TauOl  =Cos(TOI)*(Dl  1  -(-Lo»Sin(P()))*E2l-(Dl  1  +Lo*Sin(Po))*EI  1 
Taull  =  -(D1I*E31)  -  Cos(T01)*El  1*D21  -  E21»Sin(TOI)*D2l 
Tau2l  =  -(D31*E31)  -  Cos(T01)*EI  I*D41  -  E21*Sin(T01)*D41 
Tau3l  =  -(D51‘E31)  -  Cos(T01)*Ell*D61  -  E21*Sin(T01)*D61 

Tau02  =  Cus(T02)*(Dl  2  +  Lu*Sin(Po))*E22-(D12  +  Lo*Sin(Po))*E12 
Taul2  =  -(D12*E32)  -  Co.s(T02)*E12*D22  -  E22*Sin(T02)*D22 
Tau22  =  -(D32*E32)  -  Co.s(T02)*E12*D42  -  E22*Sin(T02)*D42 

G-28 


Sin(TOl) 


Sin(T02) 


Tau32  =  -(D52*E32)  -  Cos(T02)*E12*D62  -  E22*Sin(T02)*D62 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Reset  Toggles  Ij,  Jj,  Kj,  Lj  &  WW  to  zero 
C  where  j  =  0,  1 ,  2 
C 

cccccccccccccccccccccccccccccccccccccccccccc 

Togll0  =  0 
ToglJ0=0 
ToglK0  =  0 
ToglL0  =  0 

Tcglll=0 

ToglJl=0 

ToglKl=0 

ToglLl=0 

Togll2  =  0 
TogU2=0 
ToglK2=0 
ToglL2  =  0 

ToglWW  =  0 

cccccccccccccccccccccccccccccccccccccccccccccc 

c 

C  Check  for  Torque  Limit  Exceedence  in  Total  Map  Area 
C  (Checks  All  Map  Points) 

C 

C  ToglAj/Bj/Cj/Dj  =  I  indicates  that  the  Torque  Limit  was 
C  exceeded  for  some  point  in  the  Map  Area 
C 

C  Note:  This  two  Toggle  Type  is  never  reset  to  zero 
C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

If  (ABS(Tau00)  .GT.  TauOMX)  Then 
ToglA0=  1 
Endlf 

If  (ABS(TaulO)  GT.  TauIMX)Then 
TogIB0=I 
Endlf 

If  (ABS(Tau20)  .GT.  Tau2MX)  Then 
ToglC0=l 
Endlf 

If  (ABS(Tau30)  GT.  Tau3MX)  Then 
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TogID0=] 

Endif 


If  (ABS(Tau01)  .GT.  TauOMX)  Then 
ToglAl  =  l 
Endif 

If  (ABS(Taull)  .GT.  TaulMX)Then 
TogIBI  =  l 
Endif 

If  (ABS(Tau21)  .GT.  Tau2MX)  Then 
ToglCl  =  1 
Endif 

If  (ABS(Tau3I)  .GT.  Tau3MX)  Then 
ToglDl  =  l 
Endif 

If  (ABS(rau02)  .GT.  TauOMX)  Then 
ToglA2=l 
Endif 

If  vABS(Taul2)  .GT.  TaulMX)  Then 
ToglB2=l 
Endif 

If  (ABS(Tau22)  .GT.  Tau2MX)  Then 
ToglC2=l 
Endif 

If  (ABS(Tau32)  .GT.  Tau3MX)  Then 
ToglD2=l 
Endif 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

Check  for  Torque  Limit  exceedence  in  the  Stable  Map 
(Code  =  III)  Area 

ToglEj/Fj/Gj/Hj  =  1  indicate.s  that  the  Torque  Limit  was 
exceeded  for  some  point  in  Stable  Map  (Code=  111) 

Note:  These  Toggle  Types  are  P'^ver  reset  to  zero 

Togllj/Jj/Kj/Lj  =  1  indicates  that  the  Torque  Limit  was 
exceeded  at  the  particular  Stable  Grasp  Focus  point  being 
analyzed  in  the  Stable  Map  Area 

Note;  These  Tt)ggle  Types,  Along  with  ToglWW.  are  Reset  for 
Each  Iteration 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 
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If  ((ABS(TauOO)  .GT.  TauOMX)  .AND.  (Code.EQ.  Ill))  Then 
ToglE0=l 
ToglI0=l 
TogIWW=l 
Endlf 

If  ((ABS(TaulO)  .GT.  TaulMX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglF0=l 
ToglJ0=  1 
ToglWW=l 
Endlf 

If  ((ABS(Tau20)  .GT.  Tau2MX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglG0=  1 
ToglK0=  1 
ToglWW=l 
Endlf 

If  ((ABS(Tau30)  .GT.  Tau3MX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglH0=  1 
ToglL0=  1 
ToglWW  =  1 
Endif 

If  ((ABS(TauOl)  GT.  TauOMX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglEl  =  l 
Toglll  =  l 
ToglWW  =1 
Endlf 

If  ((ABS(Taull)  .GT.  TaulMX)  .AND.  (Code  .EQ.  Ill))  Then 
TcglFl  =  l 
ToglJ  1  =  1 
ToglWW  =1 
Endlf 

If  ((ABS(Tau21)  .GT.  Tau2MX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglGl  =  I 
ToglKl  =  1 
ToglWW  =  1 
Endlf 

If  ((ABS(Tau3l)  .GT.  Tau3MX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglH  1  =  1 
ToglLl  =  1 
ToglWW  =  1 
Endif 

If  ((ABS(Tau02)  .GT.  TauOMX)  AND.  (Code  .EQ.  Ill))  Then 
ToglE2=l 
ToglI2=  1 
ToglWW  =1 
Endlf 

If  ((ABS(TauI2)  GT.  TaulMX)  .AND.  (Code  .EQ.  Ill))  Then 


o  n  o  n  n 


TogIF2=l 
TogIJ2  =  l 
ToglWW=l 

Endlf 

If  ((ABS(Tau22)  .GT.  Tau2MX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglG2=l 
ToglK2=l 
ToglWW=l 

Endlf 

If  ((ABS(Tau32)  .GT.  Tau3MX)  .AND.  (Code  .EQ.  Ill))  Then 
ToglH2=l 
ToglL2=l 
ToglWW=  1 
Endif 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

Check  for  Torque  Limit  exceedence  in  the  Stable  Map  Area 
(For  All  Points  in  Area;  Code=lll).  If  True,  Write  Grasp 
Focus  BOUNDRY  Point  to  the  Respective  Finger-Joint  File. 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

If  ((TogllO  .EQ.  1)  .AND.  ((FlagOO  -  FIgACX))  NE.  0))  Then 
Write(13,220)Xg,Yg 
FlagOO  =  0 

Endlf 

If  ((TogllO  .EQ.  0)  .AND.  (Code  .EQ.  Ill)  .AND. 

#  ((FlgBOO  -  FlagOO)  ,NE,  0))  Then 
Write(13,220)Xg.Yg 
FlagOO  =  1 

Endlf 

If  ((ToglAO  .EQ.  1)  .AND.  (Code  .NE.  1 1 1)  AND. 
tt  (Codepr  .EQ.  Ill)  AND.  (FlagOO  .EQ.  0))  Then 
Write(13,220)Xg.Ygpr 
FlagOO  =  1 

Endlf 

If  ((TogIJO  EQ  I)  AND.  ({FlaglO  -  FIgAIO)  NE.  0))  Then 
Write(l4.220)Xg,Yg 
FlaglO  =  0 

Endlf 

If  ((TogIJO  .EQ.  0)  .AND.  (Code  .EQ.  Ill)  .AND. 

U  ((FlgBlO  -  FlaglO)  .NE.  0))  Then 
Write(14.220)Xg,Yg 


G-32 


FlaglO  =  1 
Endlf 

If  ((TogIBO  .EQ.  1)  .AND.  (Code  ,NE.  Ill)  .AND. 

#  (Codepr  .EQ.  Ill)  AND.  (FlaglO  .EQ.  0))  Then 

Write(14,220)Xg.Ygpr 
FlaglO  =  1 
Endlf 

If  ((ToglKO  .EQ.  1)  .AND.  ((Flag20  -  FlgA20)  ,NE.  0))  Then 
Write(15.220)Xg,Yg 
Flag20  =  0 
Endlf 

If  ((ToglKO  .EQ.  0)  .AND.  (Code  .EQ.  Ill)  .AND. 

#  ((FlgB20  -  Flag20)  .NE.  0))  Then 

Write!  15,220)Xg,Yg 
Flag20  =  1 
Endlf 

If  ((ToglCO  .EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 
tt  (Codepr  .EQ.  Ill)  .AND.  (Flag20  .EQ.  0))  Then 
Write(15,220)Xg,Ygpr 
Flag20  =  1 
Endlf 

If  ((TogILO  EQ.  1)  .AND.  ((Flag30  -  FlgA30)  NE.  0))  Then 
Write!  16, 220)Xg.Yg 
Flag30  =  0 
Endlf 

If  ((TogILO  .EQ.  0)  .AND.  (Code  .EQ.  Ill)  .AND. 
tt  ((FlgB30  -  Flag30)  .NE.  0))  Then 
Write(16,220)Xg,Yg 
Flag30  =  1 
Endlf 

If  ((TogIDO  .EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 
tt  (Codepr  .EQ.  Ill)  .AND.  (Flag30  .EQ.  0))  Then 
Write!  l6,220)Xg,Ygpr 
Flag30  =  1 
Endlf 


If  ((Toglll  .EQ.  1)  .AND.  ((FlagOl  -  FIgAOl)  .NE.  0))  Then 
Write(17.220)Xg,Yg 
FlagOl  =  0 
Endlf 
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If  ((Togin  .EQ.  0)  .AND.  (Code  .EQ.  Hi)  .AND. 
it  ((FlgBOl  -  FlagOl)  .NE.  0))  Then 
Write(17,220)Xg,Yg 
FlagOl  =  1 
Endlf 

If  ((ToglAl  .EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 
it  (Codepr  .EQ.  1 1 1)  .AND.  (FlagOl  .EQ.  0))  Then 
Write(17,220)Xg,Ygpr 
FlagOl  =  1 
Endlf 

If  ((ToglJl  .EQ.  1)  .AND.  ((Flagll  -  FIgAll)  .NE.  0))  Then 
Write(18,220)Xg.Yg 
Flagll  =  0 
Endlf 

If  ((ToglJl  .EQ.  0)  AND.  (Code  .EQ.  Ill)  .AND. 

#  ((FlgBl  1  -  Flag  1 1)  NE.  0))  Then 

Write(l8.220)Xg.Yg 
Flagll  =  1 
Endlf 

If  ((ToglBl  .EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 

#  (Codepr  .EQ.  Ill)  .AND.  (Flagll  .EQ.  0))  Then 

Write(18.220)Xg,Ygpr 
Flagll  =  1 
Endlf 

If  ((TogIKl  .EQ.  1)  .AND.  ((Flag21  -  FlgA21)  .NE.  0))  Then 
Write(19,220)Xg.Yg 
Flag21  =  0 
Endlf 

If  ((ToglKl  .EQ.  0)  AND.  (Code  .EQ.  Ill)  .AND. 
a  ((FlgB21  -  Flag21)  .NE.  0))  Then 
Write(19,220)Xg,Yg 
Flag21  =  1 
Endlf 

If  ((TogICl  EQ.  I)  AND.  (Code  .NE.  Ill)  .AND. 
it  (Codepr  .EQ.  Ill)  AND.  (Flag2 1  .EQ.  0))  Then 
Write(19,220)Xg,Ygpr 
Flag2i  =  1 
Endlf 

If  ((TogILl  .EQ.  1)  AND.  ((Flag31  -  FlgA31)  .NE.  0))  Then 
Write(20,220)Xg,Yg 
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Flag31  -  0 
Endlf 

If  ((TogILI  .EQ.  0)  .AND.  (Code  EQ.  Ill)  .AND. 

#  ((FlgB31  -  Flag31)  .NE.  0))  Then 

Write(20,220)Xg.Yg 
Flag31  =  1 
Endlf 

If((ToglDl  .EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 

#  (Codepr  .EQ.  Ill)  .AND.  (Flag31  .EQ.  0))  Then 

Write(20.220)Xg.Ygpr 
Flag31  =  1 
Endlf 


If  ((Togll2  .EQ.  1)  .AND.  ((Flag02  -  FlgA02)  .NE.  0))  Then 
Write(2l.220)Xg,Yg 
Flag02  =  0 
Endlf 

If  ((ToglI2  EQ.  0)  AND.  (Code  .EQ.  Ill)  AND. 

#  ((FlgB02  -  Flag02)  .NE.  0))  Then 
Write(2I.220)Xg.Yg 
Flag02  =  I 
Endlf 

If  ((ToglA2  .EQ.  1)  AND.  (Code  NE.  Ill)  .AND. 
n  (Codepr  .EQ.  Ill)  .AND.  (Flag02  .EQ.  0))  Then 
Write(21.220)Xg,Ygpr 
Flag02  =  1 
Endlf 

If  ((ToglJ2  .EQ.  1)  .AND.  ((Flagl2  -  FlgA12)  .NE.  0))  Then 
Wrile(22,220)Xg.Yg 
Flag  12  =  0 
Endlf 

lf((ToglJ2  .EQ.  0)  AND.  (Code  .EQ.  Ill)  .AND. 
ft  ((FlgB12  -  Flagl2)  .NE.  0))  Then 
Write(22,220)Xg.Yg 
Flagl2  =  I 
Endlf 

If((ToglB2  .EQ.  1)  .AND.  (Code  NE  111). AND. 
ft  (Codepr  .EQ.  Ill)  .AND.  (Flagl2  .EQ.  0))  Then 
Write(22,220)Xg,Ygpr 
Flagl2  =  1 
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End  If 


If  ((ToglK2  .EQ.  1)  .AND.  ((Flag22  -  FlgA22)  .NE.  0))  Then 
Write(23,220)Xg.Yg 
Flag22  =  0 
Endlf 

If  ((ToglK2  .EQ.  0)  .AND.  (Code  EQ,  111)  .AND. 

»  ((FlgB22  -  Flag22)  NE.  0))  Then 
Write(23.220)Xg.Yg 
Flag22  =  I 
Endlf 

If  ((ToglC2  .EQ.  1)  .AND.  (Code  .NE.  Ill)  .AND. 
if  (Codcpr  EQ.  Ill)  .AND.  (Flag22  .EQ.  0))  Then 
Write(23,220)Xg,Ygpr 
Flag22  =  1 
Endlf 

If  ((ToglL2  .EQ.  1)  .AND.  ((Flag32  -  FlgA32)  .NE.  0))  Then 
Write(24,220)Xg,Yg 
Flag32  =  0 
Endlf 

If  ((ToglL2  .EQ.  0)  .AND.  (Code  .EQ.  Ill)  .AND. 

#  ((FlgB32  -  Flag32)  .NE.  0))  Then 
Write(24,220)Xg,Yg 
Flag32  =  1 
Endlf 

If  ((ToglD2  EQ  1)  AND.  (Code  .NE.  Ill)  .AND. 
a  (Codepr  .EQ.  Ill)  AND.  (Flag32  .EQ.  0))  Then 
Write(24.220)Xg.Ygpr 
Flag32  =  1 
Endlf 


CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

Output  Coordinate.s  To  ’SAS^.t'.dat’  If 
the  Contact  Code  is  111  and  Nt)ne  of 
Torque  Limits  are  Exceeded. 

This  group  of  points  is  the  Net, 

Usable  Grasp  Force  Focus  .Map. 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 
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If  ((Code  .EQ.  Ill)  .AND.  (ToglWW  .EQ.  0))  Then 
ToglZZ=l 
Write(28.220)Xg,Yg 

Endif 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Here****** 

C  Update  Codepr  And  Return  To  Beginning  Of  Loop 
C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

165  Codepr  =  Code 
Ygpr  =  Yg 
170  Continue 
180  Continue 

2(X)  Formate  + ’.13,’  Iterations  Remaining’) 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

C 

C  Generate  The  Contact  Point  Data  Points  And 
C  Output  Them  To  The  File  ’cntcts^'^.dat’ 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

210  XI  =  -R*Sin(PsiO) 

Y1  =  R*Cos(PsiO) 

X2  =  -R*Sin(Psil) 

Y2  =  R*Cos(Psil) 

X3  =  -R*Sin(Psi2) 

Y3  =  R*Cos(Psi2) 

Write(27,220)Xl.Yl 

Write(27,220)X2,Y2 

Write(27,220)X3,Y3 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

c 

C  Check  Toggle  Switche.s  And  Output 
C  Warnings  If  Joint  Torque  Limits  Exceeded 
C  Or  Safe  Areas  Exist 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

If  (ToglAO  .EQ.  1)  Type  *,  'Finger  0-Joint  Zero  Torque  Limits 
#  Exceeded’ 

If  (ToglEO  .EQ.  1)  Type  *,  'in  Stable  Area' 
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Type  *.  •  • 

If  (TogIBO  .EQ.  1)  Type  *,  ’Finger  0-Joint  One  Torque  Li:nits 

#  Exceeded’ 

If  (ToglFO  .EQ.  1)  Type  *.  ’in  Stable  Area’ 

Type  *,  ’  ’ 

If  (TogICO  .EQ.  1)  Type  *,  ’Finger  0-Joint  Two  Torque  Limits 

#  Exceeded’ 

If  (ToglGO  .EQ.  1)  Type  *,  ’in  Stable  Area’ 

Type  *,  ’  ’ 

If  (ToglDO  .EQ.  1)  Type  *,  ’FingerO-Joint  Three  Torque  Limits 
tt  Exceeded’ 

If  (ToglHO  .EQ.  1)  Type  *,  ’in  Stable  Area’ 


If  (ToglAl  .EQ.  1)  Type  *,  ’Finger  1-Joint  Zero  Torque  Limits 
tt  Exceeded’ 

If  (ToglEl  .EQ.  1)  Type  *,  ’in  Stable  Area’ 

Type  *,  ’  ’ 

If  (ToglBl  .EQ.  1)  Type  *,  ’Finger  1-Joint  One  Torque  Limits 

#  Exceeded’ 

If  (TogIFl  EQ.  1)  Type  *,  ’in  Stable  Area’ 

Type  •,  ’  ’ 

If  (TogICI  .EQ.  1)  Type  *,  ’Finger  1 -Joint  Two  Torque  Limits 

#  Exceeded’ 

If  (ToglGl  .EQ.  1)  Type  *,  ’in  Stable  Area’ 

Type  *,  ’  ’ 

If  (TogIDl  .EQ.  1)  Type  *,  ’Finger  1 -Joint  Three  Torque  Limits 

#  Exceeded’ 

If  (ToglHl  .EQ.  1)  Type  *,  ’in  Stable  Area’ 

Type  *,  ’  ’ 

Type  »,  ’  ’ 

If  (ToglA2  .EQ.  1)  Type  *,  ’Finger  2-Joint  Zero  Torque  Limits 
ft  Exceeded’ 

If  (Tog!E2  .EQ.  1)  Type  *,  'in  Stable  Area’ 

Type  •.  ’  ’ 

If  (ToglB2  .EQ.  1)  Type  *,  ’Finger  2-Joint  One  Torque  Limits 
ft  Exceeded’ 

If  (ToglF2  .EQ.  1)  Type  *,  ’in  Stable  Area’ 

Type  ’  ’ 

If  (ToglC2  .EQ.  1)  T^pe  *,  ’Finger  2-Joint  Two  Torque  Limits 
ft  Exceeded’ 

If  (TuglG2  EQ.  1)  Type  *,  ’in  Stable  Area’ 

Type  *,  ’  ’ 

If  (ToglD2  EQ.  1)  Type  *,  ’Finger2-Joint  Three  Torque  Limits 
ft  Exceeded’ 

If  (ToglH2  .EQ.  !)  Type  *,  in  Stable  Area’ 

Type  *,  ’  ’ 

Type  *,  ’  ■ 
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tf  (TogiZZ  .EQ.  1)  Type  *.  Sate  And  Stable  Areas  Exist’ 

If  (TogIZZ  .EQ.  0)  Type  *,  ’Safe  And  Stable  Area  Does  Not  Exist’ 
Type  *,  ’  ’ 

Type  *.  ’  ’ 

Type  *,  ’  ’ 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

c 

C  Format  For  All  Output  Data  Files 

C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

220  Format(’{’.Fl  1 .6,’.’,F1 1 .6.’}’.’,’) 

225  Format(’{’.Fll.6.’.’.Fl  1.6.’,‘.F1I.6.’.’.F11.6.’}’.’.’) 

230  Format(’{‘.F11.6,’.’.Fl  1.6.’.’.F1I.6,’}’,’,') 

Write(l3,240) 

Write(14,240) 

Write(15.240) 

Write(16.240) 

Write(17.240) 

Write(  18,240) 

Write(19,240) 

Write(20.240) 

Write(2 1,240) 

Write(22,240) 

Write(23,240) 

Write(24,240) 

Write(26.240) 

Write(27,240) 

Write(28,240) 

VVrite(29,240) 

235  Format(’{’) 

240  Formatl’{l,l}}’) 


cccccccccccccccccccccccccccccccccccc 

c 

C  Close  The  Various  Files  That  Were  Opened 
C 

CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 

Close(12,Status=  ’Keep’) 

Close(l3,Status=  ’Keep’) 
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Close(14,Status  =  ’Keep’) 
Close(15,Status=  ’Keep’) 
Close(16,Status=  ’Ke  ;  ’) 
Close(17,Status=  ’Keep’) 
Close(I8,Status  =  ’Keep’) 
Close(19,Slatus  =  ’Keep’) 
Close(20,Status  =  ’Keep’) 
Close(2 1  .Status  =  ’Keep’) 
Close(22,Status  =  ’Keep’) 
Close(23,Status  =  ’Keep’) 
Close(24,Status  =  ’Keep’) 
Close(25,Status=  ’Keep’) 
Close(26,Status  =  ’Keep’) 
Close(27,Status  =  ’Keep’) 
Close(28.Status=  ’Keep’) 
Close(29,Status  =  'Keep') 
Stop 
End 
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Appendix  H.  Manipulator  Jacobian 
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'll 

^12 

^13 

^14 

'21 

^22 

^23 

024 

'31 

«32 

«33 

O34 

'41 

^42 

^43 

O44 

'31 

^52 

^S3 

0j4 

'61 

‘*62 

«63 

“64 

where 


a^^  =  -(//q  *  l^Cl  *  l,C12  *  l^C123)S0 
a^,  =  -(/|S;  +  /jSi2  +  ljS123)C0 
fl,3  =  -U^SI2  *  ljS123)C0 
=  -iljS123)C0 

flji  =  (//q  +  /,c;  *  /2c;2  +  ijCi23)CO 

fljj  -  -(/,s;  +  i^sn  *  1^8123) so 


O23 

=  -(^2 

812  4 

Ij  8123)  SO 

O24 

= 

C123) 

O3I 

=  0 

O32 

= 

Cl  *  i 

ljC12  *  l^C123) 

O33 

= 

C12  * 

Ij  C123) 

O34 

=  <h 

Cl  23) 

O4I 

-  0 

O4: 

=  -SO  22,3  = 

-SO 

0«4  =  ~S0 

O5I 

=  0 

O52 

=  CO 

CO 

O54  ^ 

“61 

=  1 

062 

=  0  063  = 

0 

0 

II 
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^11 

^12 

®13 

bn 

^22 

bn 

bu 

K 

b^2 

bn 

bu 

K 

b,2 

bn 

b^ 

bs\ 

bst 

bn 

bu 

b,. 

^3 

b^ 

(Note.  Same  Form  as  J^) 


where 

a^^  =  -d^Cl  *  l^Cn  *  ljC123  *  ioSm<t)j)SO 
fl,j  =  ^  l^sn  ^  1^5123)  CO 

a,j  =  -(/jS;2  1^5123)  CO 

=  -(1^5123)  CO 

flj,  =  (/,  C;  +  UCI2  *  ljC123  *  L^smo^co 
fljj  =  -(l^Sl  *  l^sn  *  ljS123)S0 
fljj  =  -(/j5V2  ♦  1^5123)  SO 
=  -(l^C123) 

«3i  =  0 


«32 

= 

Cl  *  , 

l^C12  * 

ljC123) 

«33 

-  -(/: 

C12  * 

Ij  C123) 

«34 

=  -(/3 

C123) 

«4. 

=  0 

^42 

=  -so 

°n  = 

-SO 

°u 

=  -50 

«}1 

=  0 

«32 

=  CO 

a„  = 

CO 

fl 

8 

««1 

=  1 

^62 

=  0 

«63  = 

0 

^64 

=  0 
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